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FOREWORD 


STEAP  II  is  a series  of  three  computer  programs  developed  by 
the  Martin  Marietta  Corporation  for  the  mathematical  analysis  of 
interplanetary  or  lunar  navigation  and  guidance.  STEAP  is  an 
acronym  for  Space  Trajectory  Error  Analysis  Programs.  The  first 
series  of  programs  under  this  name  was  developed  under  Contract 
NAS1-9745  for  Langley  Research  Center  and  was  documented  in  two 
volumes  ( STEAP  Users’  Manualj  STEAP  Analytical  Manual)  as  NASA 
Contract  Report  66818.  Under  contracts  NAS5-11795  and  NAS5-11873, 
the  STEAP  series’ was  extensively  modified  and  expanded  for  Goddard 
Space  Flight  Center.  This  second-generation  series  of  programs 
is  referred  to  as  STEAP  II. 

STEAP  II  is  composed  of  three  independent  yet  related  programs: 
NOMNAL,  ERRAN,  and  SIMUL.  All  three  programs  require  the  inte- 
gration on  n-body  trajectories  for  both  interplanetary  and  lunar 
missions.  The  virtual-mass  technique  is  the  scheme  used  for  this 
purpose  in  all  three  programs. 

The  first  program  named  NOMNAL  is  responsible  for  the  generation 
of  n-body  nominal  trajectories  (either  lunar  or  interplanetary) 
performing  a number  of  deterministic  guidance  events.  These  events 
include  initial  or  injection  targeting,  midcourse  retargeting,  orbit 
insertion,  and  miniprobe  targeting.  A Variety  of  target  parameters 
are  available  for  the  targeting  events.  The  actual  targeting  is 
done  iteratively  either  by  a modified  Newton-Raphson  algorithm  or 
by  a steepest-des cent/ con jugate  gradient  scheme.  Planar  and  non- 
planar  strategies  are  available  for  the  orbit  insertion  computation. 
All  maneuvers  may  be  executed  either  by  a simple  impulsive  model 
or  by  a pulsing  sequence  model. 

ERRAN,  the  second  program  of  STEAP  II,  is  used  to  conduct  linear 
error  analysis  and  generalized  covariance  analysis  studies  along 
specific  targeted  trajectories.  The  targeted  trajectory  may,  how- 
ever, be  altered  during  flight  by  retargeting  events  (computed 
either  by  linear  or  nonlinear  guidance)  and  by  an  orbit  insertion 
event.  Knowledge  and  control  covariances  are  propagated  along  the 
trajectory  through  a series  of  measurements  and  guidance  events  in 
a totally  integrated  fashion.  The  knowledge  covariance  is  processed 
through  measurements  using  a Kalman-Schmidt  or  equivalent  recursive 
weighted-least-squares  filter  with  arbitrary  solve-f or/ consider 
augmentation.  Execution  of  guidance  events  may  be  modeled  either 
by  an  impulsive  approximation  or  by  a pulsing  sequence  model.  . The 
resulting  knowledge  and  control  covariances  can  be  analyzed  by  the 
program  at  various  events  to  determine  statistical  data,  including 


iii 


probabilistic  midcourse  correction  sizing  and  effectiveness,  prob- 
ability of  impact,  and  biased  aimpoint  requirements.  Probe  release 
events  are  also  available  for  studying  missions  employing  multi- 
probe spacecraft. 

The  third  and  final  program  in  the  STEEP  II  series  is  the  simu- 
lation program  SIMUL.  SIMUL  is  responsible  for  the  testing  of  the 
mathematical  models  used  in  the  navigation  and  guidance  process. 

An  "actual"  dynamic  model  is  used  to  propagate  an  "actual"  trajec- 
tory. Noisy  measurements  from  this  "actual"  trajectory  are  then 
sent  to  the  estimation  algorithm.  Here  the  actual  measurement,  the 
statistics  associated  with  that  measurement,  and  an  "assumed"  dynam- 
ical model  are  blended  together  to  generate  the  filter  estimate 
of  the  trajectory  state.  This  process  is  repeated  continually 
through  the  measurement  schedule.  At  guidance  events,  corrections 
are  computed  based  on  the  estimate  of  the  current  state.  These  cor- 
rections are  then  corrupted  by  execution  errors  and  added  to  the 
"actual"  trajectory.  The  statistics  and  augmentation  of  the  filter, 
the  mismatches  in  the  "actual"  and  "assumed"  dynamics,  and  the  ex- 
ecution errors  and  measurement  biases  may  then  be  varied  to  determine 
the  effects  of  these  parameters  on  the  navigation  and  guidance  proc- 
ess. All  guidance  and  probe  release  event  options  defined  for  ERRAN 
are  also  available  in  SIMUL. 

The  documentation  for  STEAP  II  consists  of  three  volumes:  the 

Analytic,  Programmers'  and  User's  Manuals.  Each  of  these  docu- 
ments is  self-contained. 

The  STEAP  Analytic  Manual  consists  of  two  major  divisions. 

The  first  section  provides  a unified  treatment  of  the  mathematical 
analysis  of  the  STEAP  II  programs.  The  general  problem  description, 
formulation,  and  solution  are  given  in  a tutorial  manner.  The 
second  section  of  this  report  supplies  the  detailed  analysis  of 
those  subroutines  of  STEAP  II  dealing  with  technical  tasks. 

The  STEAP  Programmers ' Manual  provides  the  reader  with  the  in- 
formation he  needs  to  modify  the  programs . Both  the  overall  struc- 
ture of  the  programs  as  well  as  the  computational  flow  and  analysis 
of  the  individual  subroutines  is  described  in  this  manual. 

The  Users'  Manual  contains  the  information  necessary  to  oper- 
ate the  programs.  The  input  and  output  quantities  of  the  programs 
are  described  in  detail.  Example  cases  are  also  given  and  dis- 
cussed. 
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1 . INTRODUCTION 


This  Analytic  Manual  is  intended  to  provide  the  reader  with  the 
mathematical  analysis,  assumptions  and  restrictions  upon  which  the 
STEAP  II  programs  are  based.  The  volume  consists  of  three  major  divisions 
an  introductory  secLion,  an  overview  of  the  four  basic  modes  of  STEAP  II, 
and  a collection  of  detailed  analyses  of  each  of  the  technical  subroutines 
of  STEAP  II. 

The  introductory  section  includes  the  Foreword  summarizing  the 
basic  modes  of  STEAP  II  and  the  three  formal  documents  describing  STEAP  II 
This  chapter  describes  the  contents  of  the  Analytic  Manual.  The  following 
chapter  defines  the  abbreviations  and  notation  used  throughout  this 
document. 

The  second  division  of  this  report  including  chapters  three  through 
seven  provides  a convenient  overview  of  the  mathematical  foundation  of 
the  four  basic  modes  or  subprograms  of  STEAP.  Unified  discussions  of 
the  virtual  mass  n-body  propagation,  the  trajectory  targeter  NOMNAL,  and 
the  measurement  processing  and  guidance  modeling  of  the  error  analysis 
and  simulation  programs  ERRAN  and  SIMUL  are  given.  Therefore  the  reader 
desiring  to  know  the  general  assumptions  and  procedures  used  by  the  major 
modes  of  STEAP  II  will  find  these  chapters  very  helpful. 

The  third  major  division  of  this  manual  comprising  the  bulk  of  the 
volume  is  Chapter  8 which  contains  a detailed  analysis  of  the  STEAP  II 
programs  at  the  subroutine  level.  Each  of  the  technical  subroutines  is 
analyzed  individually  and  in  detail.  A cross  reference  of  the  subroutines 
by  general  categories  is  supplied.  Thus  the  analyst  viio  needs  to  make 
modifications  or  extensions  to  STEAP  II  may  use  this  chapter  to  great 
advantage . 


2 . NOMENCLATURE 


A. 


Arabic 

Symbol 


B*T 
15 'R 

^xx 
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XU 


XV 


X U 

s 


X V 

s 


E 

f 

G 

H 


symbols 

Definition 

Semi-major  axis  of  conic 

Impact  plane  parameter 

Impact  plane  parameter 

Correlation  between  position/velocity  state  and  solve- for 
parameters 

Correlation  between  position/velocity  state  and  dynamic 
consider  parameters 

Correlation  between  position/velocity  state  and  measure- 
ment consider  parameters 

Correlation  between  solve- for  parameters  and  dynamic 
consider  parameters 

Correlation  between  solve- for  parameters  and  measurement 
consider  parameters 

Eccentricity  of  conic 

Eccentric  anomaly 

True  anomaly  on  conic 

Observation  matrix  relating  observable s to  dynamic  consider 
parameter  state 

Observation  matrix  relating  observables  to  position/velocity 
s tate 


i Inclination  of  conic  (reference  body  equatorial) 

J Measurement  residual  covariance  matrix 

K Kalman  gain  constant  for  position/velocity  state 

L Observation  matrix  relating  observables  to  measurement 

consider  parameter  state 
Mean  longitude 

M Observation  matrix  relating  observables  to  solve- for 

parame ter  state 
Mean  anomaly 
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/N 

P 


/N 

Q 

r 

r 


CA 

rsi 


R 

R 


S 

S 


CA 


SI 

At 

't' 


u 

o 


Dimension  of  solve-for  parameter  state 
Dimension  of  dynamic  consider  parameter  state 
Dimension  of  measurement  consider  parameter  state 

Semilatus  rectum  of  conic 
Probability  density  function 

Position/velocity  covariance  matrix 

Unit  vector  to  periapsis  of  conic 

Solve-for  parameter  covariance  matrix 

Dynamic  noise  covariance  matrix 

Execution  error  matrix 

Unit  vector  in  plane  of  motion  normal  to  P 
Radius 

Radius  of  closest  approach 
Radius  of  sphere  of  influence 

Measurement  noise  covariance  matrix 
Actual  noise  covariance  matrix 

Unit  vector  normal  to  T in  plane  perpendicular  to  approach 
asymptote  directed  6outh  ( R = S x T ) 

Target  planet  capture  radius 

Kalman  gain  constant  for  solve-for  parameters 
Velocity  correction  covariance  matrix 
Approach  or  departure  asymptote 
Time  of  closest  approach  to  target  body 

Time  of  intersection  with  sphere  of  influence  of  target  body 
Time  interval 

Unit  vector  lying  in  ecliptic  plane  normal  to  ‘s'  . 

's'  x'k'  /N 

(T  = TX — /TT"  'where  K is  unit  normal  to  ecliptic  plane.) 

I "S  x K | 

Dynamic  consider  parameter  covariance  matrix 


3 


V 


Velocity 


V Measurement  consider  parameter  covariance  matrix 

o 

W Target  parameter  covariance  matrix 

j 

W Unit  normal  to  orbital  plane 

X Actual  position/velocity  state 

X Targeted  nominal  position/velocity  state 

X Most  recent  nominal  position/velocity  state 


B.  Greek  Symbols 


a 

r. 

j 

r 

5 

Av 

€ 


V 


j 


0 


xx 

6 


s 


XU 


0 

A 

J 

M 

v 


Auxiliary  parameters 
Guidance  matrix 
Flight  path  angle 
Declination  of  vector 
Velocity  increment 

Measurement  residual 
Errors  in  target  parameters 

Variation  matrix  relating  position/velocity  variations  to 
target  conditions 

State  transition  matrix  partition  associated  with  solve- for 
parameters 

State  transition  matrix  partition  associated  with  dynamic 
consider  parameters 

Longitude  or  right  ascension 

Projection  of  target  condition  covariance  matrix  W_  into  the 
impact  plane  J 

Gravitational  constant  of  body 

Biased  aimpoint 

Sampled  measurement  noise 
True  anomaly 


4 


p Magnitude  of  gaussian  approximation  for  midcourse  correction 

Correlation  coefficient 


a 

L 

x 

T 


j 

Q 

a> 


CO 


Standard  deviation 
Launch  azimuth 
Target  parameters 
Targeting  matrix 

State  transition  matrix  for  position/velocity  state 
Latitude 

Sensitivity  matrix 

Matrix  relating  guidance  corrections  to  target  condition 
deviations 

Longitude  of  ascending  node 
Argument  of  periapsis 
Longitude  of  periapsis 


Subscripts 

C 

CA 

f 

i 

j 

k 

K 


SI 

Superscripts 


Control  variable  (P  ) 

C 

Closest  approach  (r  ) 

CA 

Final  variable  (t^) 

Initial  variable  (t.) 

1 

Index  of  current  guidance  event  (P^) 

Index  of  current  measurement  (P,  ) 

k 

Knowledge  variable  (P  ) 

K 

Solve- for  parameter  (x  ) 

s 

Sphere  of  influence  (tgj) 


A 

T 


Augmented  variable  ( <J>  ) 

T 

Matrix  transpose  ( 4>  ) 
Matrix  inverse  ( <P 
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+ 


Variable  immediately  before  instant  (P  or  v ) 

k 

Variable  immediately  after  instant  (P  or  v ) 


E.  Abbreviations 


ALT 

CA 

ERRAN 

FTA 

GHA 

J.D. 

km 

M/C 

NOMNAL 

POI 

Q-L 

S/C 

SF/C 

SIMUL 

SOI 

STM 

STEAP 

VM 

2VBP 

3VBP 


Astronomical  unit 

Closest  approach  to  reference  body 
Error  analysis  program 
Fixed  time  of  arrival  guidance  policy 
Greenwich  hour  angle 

yr  yr 

Julian  date  (referenced  either  0 or  1900  ) 

Kilometers 

Midcourse  correction 

« 

Nominal  trajectory  generation  program 

Probability  of  impact 

Quasilinear  filter  event 

Spacecraft 

Solve- for/consider 

Simulation  program 

Sphere  of  influence 

State  transition  matrix 

.Space  Trajectories  Error  Analysis  Programs 
Virtual  Mass 

Two  variable  B-plane  guidance  policy 
Three  variable  B-plane  guidance  policy 


3.  TRAJECTORY  PROPAGATION  ANALYSIS 


The  trajectory  mode  of  STEAP  computes  an  n-body  trajectory  for  an 
infinitesimal  spacecraft  through  the  use  of  the  varicentric  or  virtual 
mass  concept.  As  explained  in  detail  by  Novak  in  reference  15,  the 
essential  idea  of  virtual  mass  n-body  trajectory  computations  is  that, 
at  any  instant  of  time,  the  gravitational  forces  exerted  by  all  the 
governing  bodies  can  be  resolved  into  one  effective  vector  emanating  from 
a virtual  mass  whose  position  and  magnitude  are  uniquely  determined . Over 
small  time  intervals,  therefore,  the  motion  of  the  spacecraft  can  be 
represented  as  a two- body  conic  section  arc  around  the  moving  and  varying 
virtual  mass.  The  computational  algorithm  of  the  STEAP  trajectory  mode 
uses  this  concept  in  determining  the  n-body  spacecraft  trajectory. 

Novak's  original  work  proved  the  validity  of  the  virtual  mass 
approach  for  the  restricted  threeybody  problem.  The  trajectory  mode  of 
STEAP  extends  its  applicability  to  general  n-body  problems.  Modeled  in 
the  trajectory  mode  are  the  best  available  mean  conic  section  orbital 
elements  of  each  of  the  planets  in  the  solar  system  plus  the  Earth's  moon. 
These  are  available  to  the  trajectory  mode  through  an  ephemeris  subroutine 
and  permit  the  determination  of  realistic  interplanetary  trajectories. 


The  basic  concepts  of  virtual  mass  n-body  trajectory  computation  are 
reviewed  here  for  reference.  In  addition,  the  computational  algorithm  at 
each  interval  along  the  trajectory  is  presented,  step  by  step,  just  as  it 
appears  in  the  trajectory  mode  of  STEAP.  For  more  details  concerning  the 
underlying  concepts,  see  reference  15. 

Consider  the  vector  differential  equations  for  the  motion  of  an 
infinitesimal  spacecraft  under  the  influence  of  n attracting  bodies  to  be 
given  by: 


r 
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E 


i=l 


(3.1) 


where  r is  the  position  vector  of  the  spacecraft  in  some  reference 

® t"h 

coordinate  system,  ,,  is  the  gravitational  attraction  of  the  i 

M th 

governing  body,  and  r^  is  the  position  vector  of  the  i body  in  the 

same  reference  system.  It  is  easy  to  show  that  an  equivalent  set  of 
equations  can  be  written  as: 
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where  the  quantities 


M,  Mc 


v» 


and  ry  are  defined  by: 


(3.2) 
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(3.3) 


(3.4) 


(3.5) 

(3.6) 


The  final  form  of  equation  (3.2),  which  is  easily  recognized  as  the 

differential  equation  for  two-body  motion,  suggests  the  essential  idea  of 

virtual  mass  computation  for  n-body  trajectories.  Over  intervals  where 

Ll  and  r can  be  treated  as  constants,  the  motion  is  two-body  with 
Mv  v 

respect  to  this  magnitude  and  position  of  the  virtual  mass.  The  computation 
of  the  n-body  orbit  in  the  trajectory  mode  results  from  piecing  together 
two- body  arcs  around  varying  magnitudes  and  locations  for  the  virtual  mass. 
The  way  in  which  each  two-body  arc  is  calculated  is  discussed  in  the  com- 
putational algorithm  to  follow. 

A close  inspection  of  the  above  equations  demonstrates  that  the 
location  and  magnitude  of  the  virtual  mass  has  the  desired  limiting 
properties.  When  the  spacecraft  is  within  the  influence  of  one  dominant 
body,  the  virtual  mass  position  and  magnitude  approximate  those  of  the 
dominant  body.  In  a transition  region,  two  or  more  bodies  may  contribute 
significantly  to  the  location  and  magnitude  of  the  virtual  mass. 

The  computational  scheme  used  within  the  trajectory  mode  of  STEAP  is 
presented  in  the  following  paragraphs.  Emphasis  is  placed  on  the  procedure 
used  for  determining  each  individual  two-body  arc  in  the  sequence.  The 
decision  concerning  the  length  of  the  interval  is  made  before  entering  the 
computational  algorithm  and  is  based  on  a fixed  true  anomaly  passage  with 
respect  to  the  virtual  mass.  Thus,  whep  the  spacecraft  is  near  the  virtual 
mass  (near  a planet  for  interplanetary  applications),  smaller  steps  are 
taken  to  ensure  the  accuracy  of  the  computation.  Over  the  heliocentric 
portions  of  an  interplanetary  flight,  when  the  spacecraft  is  far  from  the 
virtual  mass  location  and  the  trajectory  is  essentially  a heliocentric 
ellipse,  larger  computational  intervals  are  automatically  used. 

Within  each  computing  interval,  the  motion  of  the  virtual  mass  is 
assumed  to  bq  constant  velocity  with  a constant  mass  magnitude.  Two 
approaches  to  determining  this  constant  velocity  and  mass  magnitude  were 
analyzed  by  Novak  (ref.  15).  One  is  called  the  iterative  method  and  the 
other  noniterative.  The  noniterative  computation  uses,  the  values  for  the 
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virtual  mass  velocity  and  mass  magnitude  at  the  beginning  of  the  time  step 
for  the  entire  computation  interval.  Then,  at  the  beginning  of  the  new  time 
step,  new  values  are  calculated  and  assumed  consistent  with  the  new  position 
of  the  spacecraft.  This  method  results  in  position  discontinuities  in  the 
virtual  mass  trajectory  since  the  initial  values,  rather  than  any  computed 
mean  values,  are  used  over  the  step.  The  spacecraft  trajectory  itself  is 
still  continuous,  but  it  is  being  based  on  a discontinuous  virtual  mass 
tra jec tory . 

In  the  iterative  method  "average"  values  for  the  virtual  mass  velocity 
and  mass  magnitude  are  used  over  the  computing  interval.  The  values  of  r“v 

and  fi  at  the  end  of  the  interval  are  initially  estimated  and  then  iter- 
atively improved  to  force  consistency  between  the  virtual  mass  and  space- 
craft trajectories.  The  iterative  method  is  used  in  STEAP;  its  computational 
algorithm  is  presented  here,  step  by  step. 

1)  At  the  beginning  of  the  n^  time  interval  the  acceleration  terms 
from  the  previous  time  interval  are  calculated  as 


_n- 1 _n- 1 In- 1 n- 1 

..  r -r  -r  (At) 

* v V V 

-n  = E VB  VB 

v 

av 


, n- 1 2 
(At  ) 


n-1  n-1  -n-1  , n-1, 

M..  (At  ) 


”n  VE  ' VB 


av 


B 


, n-1  2 

(At  ) 


At  the  first  time  interval  r =0  and  u 

v ^ v 

av  av 


= 0. 


(3.7) 


2)  Assuming  a second  order  variation  with  time,  an  initial  guess  for 
the  final  position  and  magnitude  of  the  virtual  mass  is  made  by 
using  the  equations. 


rv  = rv  + rv  (At)  + ? (At)' 

EBB  av 


Uv  -/*v  +A*V  (At)  +fiw  (At)' 

EBB  av 


(3.8) 


The  superscripts  n have  been  dropped  for  convenience. 

All  the  succeeding  equations  are  for  the  nfc^  time  interval  unless 
otherwise  specified.  The  subscripts  B and  E refer  to  the 
beginning  and  end  of  the  computational  interval. 
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3)  Using  the  assumed  position  and  mass  magnitude  of  the  virtual 

mass  at  the  end  of  the  time  interval,  the  assumed  average  velocity 
and  mass  magnitude  for  the  virtual  mass  over  the  computational 
interval  may  be  calculated  as 


^v 

av 


+ 


(3.9) 


where  linearly  interpolates  the  virtual  mass  magnitude  to 

some  value  between  the  initial  and  final  values  (0  < < 1). 

The  initial  velocity  of  the  spacecraft  with  respect  to  the  virtual 
mass  is  now  based  on  this  assumed  average  velocity  and  is  given  by 


vs. 


B 


v 


(3.10) 


av 


4)  The  Keplerian  vector  (represents  twice  the  areal  rate)  for  the 
computing  interval  is  next  computed  as 


k = r 


vs. 


x r 


vs. 


(3 „11) 


Then  the  eccentricity  vector  is  determined  from 

k x r 


vs 


e = 


B 


vs 


B 


(3.12) 


vs 


B 


av 


The  magnitude  of  the  eccentricity  vector,  e,  represents  the 
eccentricity  of  the  conic  section  and  the  orientation  of  the 
vector  is  toward  the  conic  section  periapsis. 

5)  The  final  position  and  velocity  of  the  spacecraft  with  respect 

to  the  virtual  mass  is  calculated  next.  An  intermediate  variable 
AT  is  used  which  must  be  related  to  the  desired  At  for  the 
interval.  The  valueAT  determines  the  time  or  true  anomaly 
increment  along  the  conic  section  arc.  Again  assuming  a second 
order  variation, 

A T = At  + k At2  (3.13) 

where  K is  computed  from  information  about  the  preceding 
interval  as 


K = (3.14) 

(At)2 

The  final  position  r must  lie  in  the  plane  of  motion  defined 

VSE 

by  r and  rvg  , and  hence  can  be  expressed  as  a linear 

B B 

combination  of  the  two, 


vs. 


B 


r +At  r 
VSB  VSB 


= BO 


VS, 


(3.15) 


where  the  quantity  B is  given  by, 

2j 

V 
B 


fa 


av 


(3.16) 


e • a.. 


vs„  vs„ 

E E 


Then  the  velocity  of  the  spacecraft  with  respect  to  the  virtual 
mass  at  the  end  of  the  interval  is 


k x 


e + 


r \ 
vs_ 

E 


vs. 


vs. 


Av 

' av 


(3.17) 


6)  The  final  position  and  velocity  of  the  spacecraft  in- the  reference 
coordinate  system  are  now  computed  from 


r = r + r 
s vs  v 

E E E 


r = r + r 
s„  vs  v 
E E av 


(3.18) 


7)  It  is  necessary  to  evaluate  the  conic  section  time  of  flight  so 
that  k may  be  found  to  use  in  the  next  iteration.  First,  some 
preliminary  orbit  variables  must  be  determined.  The  in-plane 
normal  to  the  major  axis  is 

r - - 

, e i 0 


n “ J 


k e 
k x r 


(3.19) 


vs. 


k r 


, e - 0 


vs. 
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The  length  of  the  semimajor  axis  is  given  by 


fJ  v ( 1 1 - e2t 
av 


, e + 1 


1 r - - kV 


VB1 


e = 1 

’ i = B,E 


(3.20) 


av 


The  projection  of  the  radius  vector  orthogonal  to  the  major  axis, 
divided  by  b is  given  by 


n • r 


vs  . 


X = 

i 


- , i = B,E 


(3.21) 


The  mean  angular  rate  is 

( 


CJ 


M 


< 


d - * > 

av 

k b 


, e + 1 


e * 1 


(3.22) 


where  W C 0 for  hyperbolic  orbits.  The  eccentric  anomaly  is 
M 

given  by, 


Then 


sin”^  X^, 


!Av  • xi 

av  1 


e < 1 


, e = 1 


sinh  X^  , e > 1 


(3.23) 


= Ei  - eX^  i = B,E 

and  finally  the  conic  section  time  of  flight  is  given  as 


(3.24) 


Ar  = t2  - t1 


me  - mb 


U) 


M 


(3.25) 
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The  intermediate  v^ria|3lej  K , to  be  used  in  the  next  interval 
is  calculated  as  . , 

K = A,t  ~-At  (3.26) 

(At)2 

8)  The  final  positions  and  velocities  of  the  planets  are  now 
calculated  from  the  ephemeris  subroutine  and  returned  to  the 
virtual  mass  routine. 

9)  The  final  position  and  mass  magnitude  of  the  virtual  mass  are  now 
recalculated  from  the  assumed  position  of  the  spacecraft  at  the 
end  of  the  interval  and  the  planetary  aphemerides  by  using  equation 
(2).  The  velocity  and  magnitude  rate  of  the  virtual  mass  are  com- 
puted from 


where 


(3.27) 


10)  After  this  last  computation,  Step  9,  one  complete  iteration  has 

been  obtained.  The  values  of  the  final  position  and  magnitude  of 
the  virtual  mass  that  was  just  calculated  is  compared  to  the  one 
assumed  in  the  computation  of  the  spacecraft  trajectory.  If  they 
do  not  agree  to  within  a set  tolerance,  the  new  values  of  r , 

VE 
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and  k are  returned  to  Step  3 and  another  iteration  is 


performed.  However,  it  should  be  pointed  out  that  Step  8 is  to  be 
omitted  from  future  iterations.  The  final  positions  of  the 
planets  do  not  differ  from  one  iteration  to  the  next  since  the 
final  time  is  fixed. 


11)  After  two  iterations,  the  required  quantities  are  stored  for  the 
next  time  interval  and  the  algorithm  returns  to  Step  1. 

More  complete  details  for  the  above  computational  algorithm  may  be 
found  in  Novak's  report  (ref.  15).  One  point  worth  mentioning  at  this 
juncture  concerns  the  use  of  the  words  "accuracy  level"  when  referring  to 
an  orbit  computed  by  the  trajectory  mode.  As  was  mentioned  earlier,  the 
step  size  used  in  the  virtual  mass  calculation  of  n-body  trajectories  refers 
to  the  true  anomaly  arc,  with  respect  to  the  virtual  mass,  that  is  kept 
fixed  throughout  the  trajectory.  Thus,  a fixed  true  anomaly  arc  of  1 mrad 
means  that  each  individual  computing  interval,  using  the  algorithm  defined 
above,  results  in  a two- body  arc  around  t^e  effective  force  center  of  1 mrad. 
If  the  fixed  true  anomaly  arc  is  10  mrad,  then  clearly  fewer  computational 
intervals  are  used  and  the  resulting  trajectory,  neglecting  computer  noise, 
is  less  accurate. 


An  external  accuracy  level  is  input  to  the  program,  where  this  value 
is  subsequently  changed  into  a fixed  true  anomaly  arc  for  the  computing 
intervals.  An  external  accuracy  of  2.5  x 10  , for  example,  corresponds 

to  a true  anomaly  arc  of  16.57  mrad;  similarly,  an  external  accuracy  level 
of  1 x 10”  corresponds  to  a fixed  true  anomaly  of  3.6  mrad.  For  the  n-body 
problem  the  external  accuracy  level  is  a dummy  variable;  it  was  initially 
set  up  to  represent  the  accumulated  percentage  position  error  for  a restricted 
three-body  problem  after  one  orbit.  Thus  lower  accuracy  levels  imply  lower 
amounts  of  arc  for  fixed  time  anomaly  used  in  the  computations  and,  con- 
sequently, more  accurate  trajectories  that  require  more  computer  time. 
Throughout  this  report,  when  referring  to  the  computational  interval  size 
used  by  the  trajectory  mode  or  subroutine,  the  phase  accuracy  level  is 
employed . 


4.  NOMNAL  ANALYSIS 


4.1  Introduction 

The  NOMNAL  program  is  responsible  for  the  generation  of  a nominal 
trajectory  from  injection  through  midcourse  corrections  to  orbit  insertion. 
The  program  structure  of  NOMNAL  is  described  in  the  companion  volume 
STEAP  II  Programmer's  Manual.  A detailed  analysis  of  the  main  program 
NOMNAL  and  each  of  its  supporting  subroutines  is  provided  in  the  last 
section  of  this  report.  This  section  provides  a unified  discussion  of 
the  general  analysis,  assumptions,  and  modeling  upon  which  the  NOMNAL 
program  is  based. 

NOMNAL  has  been  built  with  a modular  computational  structure.  The 
basic  cycle  of  NOMNAL  consists  of  propagating  an  n-body  trajectory  using 
the  virtual  mass  technique  described  in  the  previous  chapter.  Computational 
blocks  external  to  this  basic  cycle  are  called  events.  The  first  type 
of  event  is  called  a zero  iterate  event  in  which  the  desired  trajectory 
is  approximated  to  yield  initial  conditions  for  the  n-body  trajectory. 

This  includes  both  lunar  and  interplanetary  missions. 

The  second  type  of  event  is  a targeting  event.  At  a targeting  event 
the  impulsive  velocity  correction  required  to  meet  specific  target  con- 
ditions is  computed.  A targeting  event  may  be  entered  immediately  following 
a zero  iterate  event  or  at  any  point  along  the  nominal  trajectory. 

The  third  type  of  event  is  an  orbit  insertion  event.  In  this  event 
the  impulsive  velocity  correction  and  time  of  execution  required  to  insert 
into  a desired  orbit  are  computed. 


The  targeting  and  orbit  insertion  maneuvers  may  be  specified  as 
executable  or  nonexecutable.  At  a nonexecutable  event  the  velocity  correction 
is  simply  computed  and  recorded;  at  an  executable  event  the  velocity  cor- 
rection is  actually  added  to  the  nominal  trajectory.  An  execution  event 
controls  the  execution  of  such  maneuvers.  The  maneuvers  are  executed 
either  by  a simple  impulsive  model  or  by  a more  involved  thrusting  arc 
model . 


The  major  analytic  problems  solved  in  NOMNAL  may  be 
divided  into  the  following  categories: 


conveniently 


1.  Interplanetary  zero  iterate 

2.  Lunar  zero  iterate 

3.  Targeting 

4.  Orbit  Insertion 

5.  Thrusting  Arc  Modeling 


These  topics  will  be  discussed  in  this  order  in  this  chapter. 
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4.2  Interplanetary  Zero  Iterate 


Iterative  refinement  procedures  used  in  targeting  trajectories 
require  a zero  Iterate  value  for  the  Initial,  trajectory  state.  In  the 
interplanetary  case  this  zero  iterate  state  Is  computed  from  a two  stage 
procedure  in  which  the  first  stage  approximates  the  heliocentric  phase 
by  a inassless  planet  trajectory  and  the  second  stage  approximates  the 
launch  phase  by  a simple  conic  leg. 

4.2.1  Heliocentric  Phase 

For  Interplanetary  missions  the  initial  and  final  position  vectors 
and  the  time  required  to  traverse  them  determines  the  general  character- 
istics of  the  transfer  trajectory  (see  HELIO) . Four  options  are  available 

in  specifying  the  two  terminals: 

1.  Planet  to  planet 

2.  Planet  to  specific  point 

3.  Specific  point  to  planet 

4.  Specific  point  to  second  point 

When  one  of  the  terminals  is  a planet,  its  location  at  the  relevant  time 
(either  initial  time  or  target  time)  is  computed  to  determine  the  position 
vector. 

v 

Now  suppose  that  the  initial  and  final  points  r^  and  r^  have 

been  determined  either  by  being  read  in  or  computed  internally  and  that 
the  transit  time  At  is  available.  Lambert's  theorem  states  that  the 
transit  time  between  any  two  points  on  an  ellipse  is  a function  of  the 
sun  of  the  distances  of  each  point  from  the  focus,  the  distances  between 
the  points,  and  the  semimajor  axis  of  the  ellipse,  or 

At  » f(r1  + rf,  |r\  - r | , a ) (4.1) 

Since  the  only  unknown  in  this  equation  is  the  semimajor  axis  a , 
it  may  be  solved  for  iteratively  (see  FLITE) . Battin  £ 2 J has  shown 
that  the  eccentricity  e is  actually  a function  of  the  semimajor  axis 
and  so  it  may  be  determined  simultaneously. 

The  orientation  of  the  transfer  plane  is  indicated  in  figure  4.1 
below.  The  unit  normal  to  the  transfer  plane  is 


A 

w = 


(4.2) 
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Figure  4.1.  Transfer  Trajectory  Geometry 


The  inclination  to  that  plane  i is  given  by 


cos  i = W_ 


(4.3) 


The  ascending  node  of  the  plane  fi  may  be  computed  from 


A 

w 


tan  SI  c ■ ■ 


The  central  angle  of  the  transfer  is 


(4.4) 


cos  'I/  = 


ri-  rf 
rirf 


(4.5) 


The  true  anomaly  at  the  initial  and  final  points  may  be  computed  from 

p = a (1  - e2) 

P " r r 


cos  f , 


e r. 


cos  f . 


p " rl 

i sin  f = 

1 e r^  i 


cos  f cos , -cos  f 
i ^ f 


sin 


* 


f = f + ^ 
f l 


(4.6) 


17 


Finally  the  argument  of  periapsis  is  given  by 

- A 

r • u 

cos  (w+  f^)  = — (4.7) 

where  U = (cosQ,  sinO,  0)  is  the  unit  vector  directed  toward  the 
ascending  node. 

Therefore,  the  elements  defining  the  heliocentric  conic  (a,  e,  i, 
and  the  true  anomaly  at  the  initial  and  final  times  may  all  be  computed 
from  a knowledge  of  the  initial  and  final  radii  vectors  and  the  transfer 
time.  Having  these  elements  the  position  and  velocity  vectors  and 
associated  data  at  both  the  initial  and  final  points, may  be  determined. 

4. 2. 2 The  Launch  Phase 

The  analysis  to  this  point  is  called  a massless  planet  solution, 
that  is,  the  gravitational  effects  of  the  launch  and  target  bodies  have 
been  ignored.  In  this  section  the  effects  of  the  launch  body  will  be 
considered. 

When  the  initial  terminal  is  a : planet,  the  transfer  trajectory  is 
automatically  backed  up  to  a realistic  launch  and  injection  phase  (see 
LAUNCH).  The  heliocentric  analysis  has  generated  the  velocity  vector 
v^  on  the  transfer  ellipse  at  the  initial  point.  The  hyperbolic  excess 

velocity  at  the  initial  point  is  then  given  by 


HE 


(4.8) 


-a- 

where  v^p  is  the  heliocentric  velocity  of  the  launch  planet  at  the 

initial  time.  Up  to  this  point  it  has  been  tacitly  assumed  that  all 
computations  have  been  done  in  ecliptic  coordinates.  From  this  point 
on  launch  planet  equatorial  coordinates  will  be  used. 


The  model  used  for  the  launch  phase  is  based  on  a simple  one  body 
point  mass  model.  The  spacecraft  is  to  be  launched  from  the  launch  body 
into  a circular  parking  orbit  from  which  it  is  injected  into  the  escape 
hyperbola  consistent  with  the  desired  hyperbolic  excess  velocity.  The 
parking  orbit  and  transfer  plane  are  to  be  coplanar. 

Let  the  v„„  vector  be  rotated  into  launch  body  equatorial  coordinates. 
Then  let  S denote  the  unit  vector  in  this  directions  S is  then  the  departure 
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asymptote.  If  the  launch  site  latitude  and  the  launch  azimuth  2^ 

are  specified  there  are  at  most  two  planes  satisfying  the  latitude  and 
azimuth  constraints  and  containing  Q as  indicated  in  Figure  4. 2. 


Figure  4. 2 Launch  Plane  Determination 


The  determination  of  the  transfer  plane  may  be  accomplished  in 
the  following  way.  The  normal  to  the  plane  is  given  by 

W = rxv  = rx(v+v)  = rxv  (4.  9) 

P r p 

where  r,  v are  the  launch  radius  and  velocity  vectors  in  equatorial 
coordinates.  Since  r x $ = 0 only  the  component  of  velocity  normal  to  r1 
need  be  considered  in  W.  Suppose  that  launch  occurs  at  a latitude  of 
longitude  of  8 and  azimuth  2 . Then  the  position  and  velocity  terms 
may  be  written 


"cosQcosP  " 

“-sinQsinS-  sinjDcos6cos2 

A 

r = 

sin0cos#> 

it 

cos©sin£  - sin^sinOcosE 

_sin<f> 

cosjDcosj 

A 

The  z-component  of  W may  then  be  written 


W = r v - rv  = cosc|>8in2  (4.10) 

z x y y x 
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/ A A 

To  compute  the  remaining  two  components  of  W the  conditions  W * S = 0, 
0 • W ® 1 may  be  applied  to  yield 


W 

y 


- w s s 
z.-y.-g 


s2  + s2 

x y 


(S2  + W2) 
z z 


(4.11) 


W 

x 


xs 


w s + w s 

y y z z 
S 

x 


(4.12) 


The  y-component  equation  illustrates  the  necessity  of  a constraint 
on  the  launch  azimuth  : 


sin  2 ^ 

Li 


cos2  4>c 

2T 

cos  *5* 


(4.13) 


where  <$>  is  the  declination  of  the  departure  asymptote. 

D 


The  ambiquity  in  sign  in  the  y-component  distinguishes  between  the 
long  and  short  coast  time  orbits.  The  positive  sign  designates  the  long 
coast  solution;  the  negative  sign,  the  short  coast.  The  user  specifies 
which  of  the  two  solutions  he  wants  by  input. 

Having  determined  the  plane  of  motion  the  in-plane  characteristics 
must  be  computed.  The  energy  and  eccentricity  of  the  departure 
hyperbola  are  given  by 


C 


3 


(4. 14) 


e 


1 + 


r 


(4. 15) 


where  r^  is  the  input  desired  parking  orbit  radius  and  p is  the  launch 

planet  gravitational  constant.  The  orientation  within  the  plane  is 
specified  by  the  argument  of  periapsis  lO  which  may  be  determined  from 
the  true  anomaly  f of  the  departure  asymptote  S and  the  eccentricity 

of  the  hyperbola  (4.15).  The  true  anomaly  at  injection  f is  input 

by  the  user.  Thus,  the  injection  state  may  easily  be  computed  from  the 
standard  conic  formula. 


To  determine  the  required  time  of  injection  a realistic  launch  pro- 
file is  now  imposed.  The  size,  shape,  and  orientation  of  the  hyperbola 
within  the  launch  plane  has  been  determined  above.  The  launch  to  in- 
jection phase  is  divided  into  three  sections:  a first  burn  arc  from 

launch  to  parking  orbit  specified  by  a central  angle  ^ and  a time  interval 


At^,  a coasting  arc  in  the  parking  orbit  specified  by  k (the  inverse 


parking  rate),  and  a second  burn  arc  from  parking  orbit  to  injection  spec- 
ified by  the  central  angle  'I' ^ and  time  interval  At^.  The  geometry  is 


illustrated  in  Figure  4. 3 below. 


A 

Q 


Figure  4. 3 Launch  Profile 


The  right  ascension  at  launch  © is  determined  from  the  fact  that 

Lt 

the  launch  plane  satisfies  the  latitude,  azimuth,  and  S constraints 

W sin4>  sin  £ + W cos  £_ 


cos  0 ^ = 


x L L v 

w2  - 1 

z 


W sin^>  sin  2 - W cos  £ 

sin  0.-2 £ ± S £ 

L vr  - l 

Z 


(4. 16) 
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and  the  unit  vector  toward  the  launch  site  r^  is  given  by 


T 

"r  = (cos<J>Lcos  © L>  cos^sin  Q L>  sin<f>L)  (4.17) 

Since  r^  is  also  known  the  computations  necessary  to  compute  the  time 

interval  AtTT  from  launch  to  injection  are  straightforward  and  may  be 
LI 

found  in  detail  in  LAUNCH.  The  time  at  which  launch  must  occur  coincides 
with  the  time  that  the  launch  site  passes  through  the  launch  plane  which 
is  equivalent  to  the  time  at  which  the  launch  site  latitude  and  launch 
right  ascension  are  consistent.  This  may  be  computed  from 

( e -9  - GHA)  mod  2 ir 

t = (4.18) 

L uj 

where  u;  is  the  rotation  rate  of  the  planet  and  where  GHA  is  the  Greenwich 
hour  angle  at  0n  U.T.  on  the  launch  date.  The  time  of  injection  t-j.  is 

then  given  by 


4. 3 Lunar  Zero  Iterate 

The  generation  of  a lunar  zero  iterate  proceeds  in  two  steps.  The 
first  step  involves  the  targeting  of  a patched  conic  trajectory;  the 
second  then  targets  a multi-conic  trajectory  to  the  desired  conditions. 

The  controlling  subroutine  for  the  lunar  targeting  is  LUNA. 

4.  3. 1 Patched  Conic  Targeting 

The  lunar  patched  conic  phase  (see  LUNGON,  LUNTAR)  generates  a patched 
conic  trajectory  which  satisfies  both  launch  conditions  at  earth  and  target 
conditions  at  closest  approach  to  the  moon.  The  launch  conditions  include 
launch  from  a site  specified  by  latitude  <l>  and  longitude  0 at  an  azimuth 

2,  into  an  intermediate  parking  orbit  of  radius  r until  injection.  The 

Jj  p 

target  conditions  include  time  at  closest  approach  t^,  radius  at  closest 
approach  r^,  inclination  to  the  lunar  equator  i , and  semimajor  axis  at 
the  lunar  hyperbola 


For  the  patched  conic  model,  the  moon’s  position  is  fixed  at  its 
location  at  the  time  the  sphere  of  influence  is  pierced.  The  eccentricity 
of  the  lunar  phase  hyperbola  is 


e 


CA 


(4.  20) 


where  a < 0.  The  hyperbolic  time  At  to  go  from  R (the  radius  of  the 
lunar  sphere  of  influence)  to  periapsis  is  computed  from 


~ f^*M»  aCA’  eCA’  RSI^  (4.  21) 

where  is  the  lunar  gravitational  constant.  Thus,  the  time  at  which 
the  probe  should  intersect  the  SOI  is 


tSI  fcCA  " ^4*  22') 

Now  any  point  on  the  lunar  SOI  can  be  described  by  giving  two 
angular  components:  declination  5 and  right  ascension  0 for  example. 

Denote  the  vector  from  the  center  of  the  earth  to  such  a point  on  the 
SOI  by  Then  by  setting 


$ 


(4.  23) 


the  plane  including  the  vector  S and  satisfying  the  launch  site  latitude 
and  azimuth  conditions  may  be  determined  as  it  was  in  the  previous  section 
for  the  interplanetary  case.  The  normal  W to  the  transfer  plane  (identical 
to  the  parking  orbit  plane)  is  thus  given  by 
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Now  let  the  injection  point  on  the  parking  orbit  of  radius  r 

— * p 

be  located  an  angle  a from  the  vector  - R^..  Denote  the  radius  vector 
to  that  injection  point  by  r^.  Then  the  situation  is  illustrated  in 
Figure  4.4  below. 


Figure  4.4  Lunar  Patched  Conic  Targeting 


The  three  controls  a , 5,  0 determine  a unique  patched  conic  tra- 
jectory (see  LUNCON).  The  elements  of  the  geocentric  phase  may  be 
computed  from  the  simultaneous  solution  of  the  equations 
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(4.  25) 


R, 


«£L  r...eh 

1 + e cos  ( tt  - a ) 
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= a(l  - e) 


to  yield  the  semimajor  axis  and  eccentricity  of  the  geocentric  conic 
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RI  ~ ri 

r ^ cos  ( ir  - a ) 


(4.26) 
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(4.  27) 


The  position  and  velocity  R , V on  the  geocentric  conic  may  then 

be  evaluated  at  the  lunar  SOI.  The  state  relative  to  the  moon  at  this 
patching  point  is  given  by 


SI 


- ** 


(4.  28) 
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where  R^,  are  the  position  and  velocity  vectors  of  the  moon  with  respect 
to  the  earth. 


Given  the  state  relative  to  the  moon  the  target  parameters  r^,  iCA, 

and  an,  may  be  evaluated  from  the  usual  conic  formulae.  However,  for 

linearity  purposes,  the  impact  plane  parameters  B*T  and  B*R  are  sub- 
stituted for  the  parameters  and  i , 

The  actual  targeting  procedure  (see  LUNTAR)  may  now  be  described. 
Suppose  that  on  the  k-th  iterate  the  best  values  of  the  controls  are 
denoted  by  (ar^,  6^,  0^) . Suppose  that  the  resulting  target  values  are 

given  by  (a^,  E^T^,  B*R^).  The  Newton-Raphson  scheme  is  then  used  to 

generate  the  k+1  st  values  for  the  controls. 

The  first  control  is  first  perturbed  by  the  amount  Aa  while  hold- 
ing the  other  controls  at  the  k iterate  values  and  the  resulting  trajectory 
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determined.  Suppose  that  the  resulting  target  values  differ  from  the  k-th 
iterate  values  by  the  amounts  ^aa,  AB^T^,  AB*Ra).  Then  the  5 and  9 con- 
trols are  each  perturbed  in  the  same  manner  and  the  resulting  perturbations 
in  the  target  parameters  denoted  by  (Aa^,  AB-T^,  AB*R^)  and  (Aa^,  AB-Tq,  AB* 

respectively.  The  "sensitivity"  matrix  is  then  defined  to  be 
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(4.  30) 


The  targeting  matrix  is  then  defined  to  be  <f>  . The  values  of  the 

controls  to  be  used  on  the  next  iteration  are  then  given  by 


(4.  31) 


where  B*T  and  B°R  are  the  values  of  the  impact  parameters  corresponding 
to  the  desired  values  i^  and  r^.  (IMPACT) 

When  the  values  of  the  target  parameters  are  within  given  tolerances 
of  the  desired  values s the  patched  conic  phase  of  the  targeting  is  ter- 
minated and  the  multiconic  stage  begun.  The  time  of  injection  of  the 
final  targeted  patched  conic  is  computed  from  conic  formula  to  use  in 
that  second  stage. 


4. 3. 2 Multiconic  Targeting 


The  second  phase  of  the  generation  of  a lunar  zero  iterate  involves 
the  targeting  of  a multi-conic  trajectory  (see  MULTAR,  MULCON). 


Multi-Conic  Trajectory  Propagation 


The  multi-conic  propagation  scheme  has  recently  been  introduced  as 
an  effective  intermediate  betwen  patched  conic  and  precision  integrated 
trajectories  (Ref,  4), 

A detailed  analysis  of  the  propagation  of  a trajectory  by  the  multi- 
conic technique  is  provided  in  the  analysis  of  subroutine  MULCON.  A 
heuristic  description  of  this  scheme  will  be  discussed  in  this  section. 

The  equations  defining  the  motion  of  a spacecraft  traveling  under 
the  influence  of  the  earth  and  moon  may  be  written 

? = . . Vm  _ ffe  (4.32> 

“ rE  rM  "EM 

where  r^,  r^,  and  R^  are  the  position  vectors  of  the  spacecraft  relative 

to  Earth,  the  spacecraft  relative  to  the  moon,  and  the  moon  relative  to 
the  Earth  and  pE  and  are  the  gravitational  constants  of  the  Earth  and 

moon  respectively. 

A graphic  description  of  the  multi-conic  scheme  is  provided  in  Figure 
4. 5 below. 


Figure  4.5  Schematic  Representation  of  Multi-conic  Propagation 
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The  state  of  the  spacecraft  at  the  beginning  of  the  n-th  iterative 

step  is  indicated  by  the  point  A,  The  trajectory  AB  is  a simple  conic 

about  the  earth  determined  by  the  initial  state  at  the  time  t and  pro- 

n 

pagated  over  the  time  interval  At  = t t^.  This  corresponds  to 
ignoring  the  last  two  terms  in  equation  (4. 32)  above. 

The  second  leg  of  the  trajectory  BC  accounts  for  the  "third  term"  or 
indirect  force.  Here  the  third  term  is  evaluated  at  the  beginning  and 
at  the  end  of  the  interval  [tn>  t J.  The  net  effect  of  the  force  is 

approximated  by  assuming  that  a constant  force  equal  to  the  average  of 
the  two  values  of  the  indirect  force  acted  over  the  interval.  That 
perturbation  is  represented  by  the  arc  BC. 

Finally,  the  effect  of  the  direct  lunar  force  is  considered.  The 
state  of  the  spacecraft  relative  to  the  moon  at  the  point  C (correspond- 
ing to  the  time  t is  first  computed.  This  state  is  then  propagated 

linearly  backwards  in  time  over  the  time  interval  At  arriving  at  the 
point  D.  Then  a simple  forward  conic  propagation  relative  to  the  moon 
over  the  interval  At  generates  the  path  DE.  This  may  then  be  converted 
to  geocentric  coordinates  to  begin  the  next  multi-conic  step. 

The  multi-conic  technique  has  been  shown  to  efficiently  approximate 
n-body  trajectories  to  a very  reasonable  degree  of  accuracy.  Therefore, 
an  intermediate  stage  of  targeting  using  this  model  was  built  into  STEAP. 


Multi-Conic  Targeting 


The  actual  targeting  of  the  multi- conic  trajectory  is  controlled 
by  the  subroutine  MULTAR.  The  targeting  scheme  uses  Newton-Raphson  itera- 
tion to  do  the  targeting.  Let  the  k-th  iterate  values  of  the  Injection 
state  in  earth  ecliptic  coordinates  and  time  be  denoted  r^>  v^,  t^ 


respectively*.  The  problem  then  becomes  the  generation  of  an  improved 
injection  state  and  time  Vk+1’  fck+l* 


The  k-th  value  of  injection  state 


is  propagated  forward 


using  the  multi -conic  propagator  to 
The  resulting  values  of  B-T^,  B*Rk» 


determine  a final  state  near  the  moon, 
a^,  and  t^  ^ achieved  on  the  tra- 


jectory as  well  as  the  target  values  B*T  and  B*. R (consistent  with  the 
desired  values  of  r^  and  i ) are  computed.  The  errors  in  the  four 


target  conditions  are  then  computed 


(4.34) 
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If  the  error  in  each  parameter  is  less  than  the  allowable  tolerance, 
the  process  is  terminated.  If  convergence  has  not  been  achieved  a Newton- 
Raphson  iteration  is  made.  The  control  variables  are  now 


and  the  target  parameters  are 


aCA*  B'T'  B'R-  ‘CA 


A complicating  factor  is  introduced  because  of  the  time^variable 


'inj* 


The  result  of  the  patched  conic  targeting  is  a state  r , 


v in 
o 


earth  ecliptic  coordinates  at  the  time  tQ.  However,  since  the  earth 

is  rotating  about  the  earth-moon  barycenter,  when  the  injection  time  is 
varied  the  injection  state  (both  position  and  velocity)  must  be  rotated 
to  insure  that  an  otherwise  equivalent  state  is  being  used. 


Thus,  a sensitivity  matrix  is  computed  by  numerical  differencing 
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The  k+1  st  iterate  is  then  corrected  by 
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(4. 36) 


The  Newton-Raphson  process  is  continued  until  the  errors  Ar^  are 
all  within  the  desired  tolerances. 


4.4  N-Body  Targeting 
4.4.1  Parameters 

N-Body  targeting  events  may  be  required  at  the  start  of  a trajectory 
or  at  some  interior  point  along  a trajectory.  In  either  case  the  current 
position  vector  and  time  (perhaps  generated  as  a zero  iterate). are  held 
at  their  original  values  while  the  velocity  components  are  varied  to  meet 
three  target  conditions.  The  target  parameters  may  be  chosen  from  the 
list  supplied  in  table  4.1  below. 


Table  4.1  Target  Parameters  and  Codes 


1. 

(available) 

5. 

B-T 

9. 

asi 

2. 

fcSI 

6. 

B°  R 

10. 

Xf 

3. 

tcs 

7. 

rCA 

11. 

yf 

4. 

fcCA 

8. 

i 

12. 

<2  _ 
t 

The  parameter  tg^.  prescribes  the  time  at  which  the  target  body  SOI 
is  intersected.  The  parameters  t^g  and  t^  refer  to  time  at  closest 
approach  to  the  target  body:  t^g  indicates  that  the  integration  is  stopped 

at  the  SOI  and  the  time  at  closest  approach  extrapolated  from  conic  formula 


while  t indicates  that  the  time  at  closest  approach  1b  determined  by 

actually  integrating  to  closest  approach.  In  lunar  targeting  a time 
variable  may  be  replaced  by  the  semimajor  axis  a^  at  the  lunar  SOI. 

In  this  case  the  n-body  integration  is  stopped  at  the  SOI  for  the  evalu- 
ation of  the  target  parameters.  These  four  parameters  thus  specify 
the  stopping  conditions  of  the  integration  then.  If  one  of  the  para- 
meters tQ  , t , or  a is  triggered,  the  integration  is  stopped  at  the 

target  body  SOI  and  all  target  parameters  are  evaluated  at  that  point 
using  conic  formulae  if  necessary.  If  t^  is  a target  parameter,  the 

integration  is  stopped  at  closest  approach  to  the  target  body  for  the 
computation  of  parameters.  If  none  of  these  four  parameters  are  triggered, 
the  integration  stops  at  the  target  time. 

The  other  seven  parameters  are  automatically  evaluated  at  the 
appropriate  stopping  condition.  B.T  and  B*R  are  the  impact  plane  para- 
meters (see  IMPACT),  r^  is  the  radius  at  closest  approach  to  the  target 

body,  i is  the  inclination  with  respect  to  the  target  body  equatorial 
system  (see  IMPACT)  and  x^,  y^,  z^  are  the  inertial  ecliptic  coordinates 

at  the  stopping  conditions. 


4.4.2  General  Targeting  Procedure 


For  efficiency  it  is  sometimes  necessary  to  introduce  auxiliary 
parameters  in  place  of  the  selected  target  parameters  within  the  actual 
targeting  procedure.  Thus,  if  and  i are  specified  as  target  para- 


meters, auxiliary  parameters  of  B*T  and  B*R  are  substituted  for  them. 

The  reason  for  this  is  that  the  impact  plane  parameters  are  more  linear 
functions  of  the  velocity  components  than  are  r^  and  i.  Therefore,  the 


terms  target  parameters  and  auxiliary  parameters  are  used.  The  target 
parameters  r are  those  parameters  for  which  the  user. has  actually  requested 
desired  values;  the  auxiliary  parameters  a are  those  parameters  which 

the  program  uses  to  perform  the  targeting.  Thus  f = a unless  1 and  r 

» 


are  target  parameters.  In  that  case  a - B*T  if 
if  r = i. 


CA 


and  or.  = B‘R 
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The  general  targeting  program  TARGET  controls  the  refinement  of  the 
velocity  components  to  meet  the  desired  conditions.  TARGET  use.s  either 
of  two  iterative  processes  to  perform  the  targeting:  either  the  Newton- 

Raphson  scheme  or  a steepest  descent/conjugate  gradient  algorithm. 
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In  either  case  suppose  that  on  the  k-th  iteration  the  values  of 
the  velocity  components  are  denoted  v^.  Denote  the  resulting  values 

of  the  target  and  auxiliary  parameters  by  * and  or  respectively . If 

1C  K , 

the  target  values  r agree  with  the  desired  values  f to  within  the  input 

iC 

tolerances  the  process  is  terminated.  Otherwise  the  difference  between 
the  current  auxiliary  parameters  and  their  desired  values  Sk  are  computed 


A a;  = 


(4.  37) 


TARGET  then  calls  on  TARMAX  or  DESENT  to  compute  the  velocity 
correction  Av  to  be  added  to  obtain  the  k+1  st  iterate  values  by  either 
the  Newton-Raphson  or  steepest  descent/ con jugate  gradient  techniques 
discussed  in  the  next  two  sections.  In  either  case  assume  the  correction 
is  generated 


Av  = vk+1  - v^  = f (Acs)  (4.  38) 

Two  checks  are  available  to  guard  against  divergence  in  the  target- 
ing procedure:  the  maximum  step  check  and  the  bad  step  check.  In  the 
maximum  step  scheme  a maximum  allowable  velocity  correction  magnitude 
Avm  is  read  in  as  input.  If  the  correction  determined  by  (4.  38)  has  a 

magnitude  larger  than  Av^,  all  components  are  scaled  down  to  yield  a 

correction  within  the  maximum  size.  Therefore,  if  one  wants  to  play  safe 
he  can  read  in  a AvM  that  Is  perhaps  one  hundred  times  larger  than  the 

perturbation  size  dv  used  is  predicting  the  step.  The  program  will  then 
insure  that  no  steps  larger  than  a hundred  times  the  perturbation  size 
will  be  allowed.  Thus,  the  correction  may  be  forced  to  stay  within  a 
region  where  the  linear  assumptions  are  hopefully  valid. 

The  second  scheme  might  be  called  an  "a  posteriori"  method  in  com- 
parison with  the  "a  priori"  method  listed  above.  In  the  bad  step  check 
a scalar  error  or  loss  function  « Is  assigned  to  each  iterate  as 


e k = W • A ® (4.  39) 

where  W is  a vector  of  weights.  Whenever  a step  leads  to  a scalar  error 
larger  than  the  previous  step,  the  current  correction  is  reduced  by  one 
quarter  recursively  until  a step  with  a smaller  error  is  determined. 

Thus  large  steps  that  reduce  the  error  will  be  allowed;  only  when  they 
increase  the  error  will  they  be  decreased. 


A. 4. 3 Newton-Raphson  Iteration 

In  the  Newton-Raphson  technique,  the  errors  in  the  auxiliary 
parameters  are  iteratively  driven  to  zero  by  varying  a set  of  three 
velocity  controls,  C^,  C^,  and  C^.  Two  different  sets  of  these 

controls  are  available.  In  the  first  option,  is  simply  the  in- 
crement to  the  ith  Cartesian  component  of  heliocentric  ecliptic  in- 
ertial velocity  provided  by  the  targeting  impulse.  The  dependence 
of  the  targeting  velocity  increment  Av  on  these  controls  is  then 
clearly 


Av  = C1  i + C2  + C3  k 


(4.40) 


where  _i,  j_,  and  k are  the  respective  unit  vectors  along  the  ecliptic 
inertial  coordinate  axes.  The  second  control  option  is  somewhat 
more  complicated.  It  deals  with  the  velocity  relative  to  the  launch 
planet  in  a rotating  spherical  coordinate  system  referenced  to  the 
trajectory.  The  current  velocity  vector  determines  the  zero-lati- 
tude zero-longitude  direction  and  the  current  angular  momentum  vec- 
tor of  the  trajectory  relative  to  the  launch  planet  defines  the  +z 
or  polar  direction.  The  three  controls  then  are  respectively  the 
increase  in  length,  the  latitude,  and  the  longitude  of  the  new  ve- 
locity relative  to  the  launch  planet  after  addition  of  the  targeting 
impulse.  Figure  4.5a  defines  the  controls  pictorially  for  the 
case  of  the  earth  as  launch  planet. 
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Figure  4.5a  Pictorial  Definition  of  Launch- 

Planetocentric  Targeting  Controls 
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The  dependence  of  the  targeting  velocity  increment  on  these 
controls  is 


Av  = [ ( | | v|  | + C^)  cos  C2  cos  C3  - I I v|  | ] V + ( | | v|  | + C1) 

sin  C2  cos  U + (| | v| [ + Cj)  sin  C3  W (4.41) 


where  V is  a unit  vector  in  the  direction  of  the  launch-planetocentric 
velocity  just  prior  to  the  targeting  impulse , W is  a unit  vector 
in  the  direction  of  the  angular  momentum  vector  of  the  launch- 
planetocentric  trajectory  and  U = W x V. 

Using  the  dependence  of  Av  on  the  particular  set  of  controls 
at  hand,  a sensitivity  (Jacobian)  matrix  $ of  the  auxiliary  param- 
eters with  respect  to  the  controls  is  approximated  by  numerical 
differencing.  The  ijth  element  of  $ is  by  definition 


3G. 
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i = 1,  2,  3 
j - 1,  28  3 


Now  partitioning  $ into  columns  as  follows 
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(4. 42a) 


(4.42b) 


the  jth  column  is  given  by 


lim 

Cf° 


Aa 

cj 


(4. 42c) 


Thus  the  columns  of  the  sensitivity  matrix  can  be  approximated  by 
successively  perturbing  the  three  velocity  controls.  The  control 
correction  for  the  kth  iteration  is  then  given  by  the  standard 
Newton-Raphson  formula 


'^k1  ^ 


(4.43) 
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where  Aa  is  the  error  vector  of  the  auxiliary  parameters  on  the 
previous  iterate  from  their  desired  values. 

The  Newton-Raphson  scheme  may  be  slightly  modified  to  yield  a 
more  efficient  targeting  algorithm.  The  modification  is  based  on 
a premise  that  the  characteristics  of  a low-integration-accuracy 
trajectory  mirror  those  of  a higher  accuracy  trajectory  targeted 
to  identical  mission  constraints.  Thus,  a targeting  matrix  com- 
puted about  a given  trajectory  at  a low-accuracy  level  should  re- 
main valid  for  similar  trajectories  at  higher  accuracy  levels. 

This  assumption  has  been  verified  by  experimentation. 

The  modified  targeting  scheme  then  proceeds  as  follows.  A 
trajectory  is  targeted  to  the  desired  target  conditions  at  a low 
accuracy  level,  constructing  the  targeting  matrix  at  each  iteration. 
The  targeting  matrix  evaluated  about  the  targeted  trajectory  at 

this  low  accuracy  level  is  stored.  The  corresponding  targeted 

velocity  at  this  low  level  v is  then  used  as  the  first  iterate 

JLj 

at  a slightly  higher  accuracy.  Because  of  the  change  in  the  inte- 
gration step  size  the  desired  target  conditions  will  not  be  real- 
ized. However,  the  matrix  $ may  be  used  to  predict  an  improved 

Li 

velocity  v^.  for  that  intermediate  level.  This  process  is  contin- 
ued until  the  desired  accuracy  level  is  reached.  The  the  targeting 
matrix  $ is  used  repeatedly  until  a velocity  is  determined  which 

Li 

yields  a trajectory  satisfying  the  desired  target  conditions. 
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4,4,4  Steepest  Descent/ Conjugate  Gradient  Iteration 


An  alternate  scheme  is  provided  for  the  generation  of  the  next 

iterate  by  use  of  steepest  descent/ conjugate  gradient  method  (DESENT). 

The  current  gradient  g is  computed  by  numerical  differencing.  For  the 

0 

x-component  of  g^  the  corresponding  component  of  velocity  is  perturbed 
by  dv 


(4.44) 


The  initial  state  (r,  v ) is  then  propagated  to  the  final  stopping 

conditions.  Let  the  auxiliary  parameters  of  that  trajectory  be  denoted 
The  error  (or  loss  function)  associated  with  the  perturbed  state  is 

then 


e = W • 
x 


(4.45) 


-*•  _►* 
where  W represents  the  weighting  factors  and  ot  are  the  desired  target 

conditions.  The  x-component  of  the  current  gradient  is  then 


(4.46) 


The  y-  and  z-componento  of  the  gradient  are  computed  similarly  by 
perturbing  the  y-  and  z-components  respectively.  The  corrected  gradient 
is  then  given  by 


, steepest  descent  step 


I K!Z  . 


I 8. 


2 p + gc  , conjugate  gradient  step 


(4.47) 


where  the  subscript  c refers  to  a current  parameter,  p refers  to  a previous 
step.  The  unit  vector  in  the  direction  of  the  next  step  is  then  given  by 


q 


c 


(4.48) 


The  step  size  is  now  determined  as  the  correction  leading  to  the 

minimization  of  the  loss  function  in  the  direction  predicted  by  (4.48). 

The  directional  derivative  of  the  scalar  error  in  the  direction  q is 

c 


d = %.  ■ gc  (4.49) 

The  nominal  optimal  step  size  h is  computed  from  a linear  approxi- 
mation to  null  the  error 

h = ^ (4.  50) 

The  initial  state  corresponding  to  this  correction  is  then  propagated 
to  the  final  stopping  conditions  and  the  resulting  error  « computed.  The 
three  conditions 


y (0)  = « 

y(h)  = ? 
y'  (0)  = d 

may  now  be  applied  to  the  formula  of  a parabola 


(4.51) 


* * o 

* = a (x  - h ) 


(4.52) 

* * 

to  predict  the  optimal  step  size  h yielding  the  minimum  error  e 
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&v  = h q (4. 54) 

c 

4.4.5  Outer  Targeting 

All  of  the  targeting  problems  that  involve  stopping  conditions  at 
the  SOI  or  at  closest  approach  to  the  target  body  require  a trajectory 
that  at  least  intersects  the  target  body  SOI. 

Since  the  massless  planet  initial  conditions  will  not  always  satisfy 
this  requirement  some  provision  must  be  made  to  refine  those  conditions 
to  obtain  acceptable  ones.  An  effective  algorithm  has  been  constructed 
to  accomplish  this. 

When  any  trajectory  has  not  encountered  the  target  body  SOI  within 
a prescribed  time,  the  closest  approach  conditions  r^,  v^  are  noted 

(see  Figure  4.6).  An  "artificial"  sphere  of  influence  is  then  constructed 
about  the  target  body  having  a radius  1. 2 times  the  value  r^  just  noted. 

The  trajectory  will  then  intersect  this  artificial  SOI  even  with  small 
perturbations  in  the  initial  velocity.  The  normal  targeting  procedure 
is  now  used  with  target  values 


B'T.  = B-Ra  = 0 
A A 


(4. 55) 


where  the  subscript  A indicates  "artificial"  target  conditions  and  R 

b _L 

indicates  the  actual  SOI  radius.  The  initial  conditions  consistent  with 
these  "artificial"  conditions  will  then  yield  a trajectory  headed  straight 
for  the  center  of  the  target  body  when  the  artificial  SOI  is  intersected 
which  should  result  in  a trajectory  hitting  the  actual  SOI. 
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Figure  4. 6 Outer  Targeting  Scheme 


4. 5 Orbit  Insertion 

4, 5. 1 Orbit  Insertion  Structure 

The  second  type  of  guidance  maneuver  is  an  orbit  insertion  event. 

The  orbit  insertion  event  is  divided  into  two  distinct  subevents;  an 
orbit  insertion  decision  event  and  an  orbit  insertion  execution  event, 
occurring  at  a later  time.  There  are  two  possible  strategies  available 
for  the  orbit  insertion  decision  event;  one  specifying  that  the  desired 
orbit  is  automatically  coplanar  with  the  incoming  hyperbola  and  one 
specifying  the  orientation  of  the  desired  final  orbit. 

The  orbit  insertion  decision  event  occurs  at  a time  specified  by  the 
user  (generally  when  the  spacecraft  is  well  within  the  target  body  SOI.) 
The  general  procedure  begins  after  exiting  from  the  trajectory  propagation 
cycle.  The  state  of  the  spacecraft  with  respect  to  the  target  body  is 
computed  and  the  conic  extension  of  the  trajectory  is  computed.  The 
possible  intersection  point  of  this  trajectory  with  the  desired  orbit  are 
then  investigated.  If  there  are  no  points  of  intersection,  a series  of 
modifications  are  checked  to  determine  an  optimal  modification  which  leads 
to  a tangential  or  intersecting  solution  for  the  coplanar  or  nonplanar 
strategies  respectively.  The  impulsive  velocity  correction  corresponding 
to  this  solution  is  then  computed  along  with  the  time  interval  (from 
conic  formulae)  from  the  time  of  the  decision  to  the  required  time  of 
execution. 
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After  making  these  computations  the  trajectory  propagation  program 
is  re-entered.  If  the  insertion  event  is  to  be  executed,  an  execution 
event  is  set  up  for  the  appropriate  time  before  re-entering  the  trajectory 
mode.  At  that  time  the  trajectory  program  is  exited  and  the  impulsive 
correction  added  on. 

4.5.2  Coplanar  Strategy 

The  details  of  the  coplanar  orbit  insertion  decision  are  available 
in  COPINS.  A heuristic  description  of  this  option  will  be  given  here. 

In  the  coplanar  option  the  desired  orbit  is  selected  within  the  orbital 
plane  of  the  approach  hyperbola.  The  target  parameter  specified  by 
the  user  include  the  elliptical  semimajor  axis  a,  eccentricity  e,  and 
periapsis  shift  • The  periapsis  shift  is  defined  as  the  angle  from 

the  periapsis  of  the  approach  hyperbola  to  the  periapsis  of  the  desired 
orbit  measured  positive  in  the  direction  of  motion  (see  Figure  4.7). 


Q 


a(l-e) 
a (1+e) 


Figure  4,  7 Definition  of  Coplanar  Insertion  Parameters 


There  are  three  possible  situations  which  may  arise  in  the  deter- 
mination of  the  points  of  intersection:  there  may  be  one,  two,  or  no 

solutions.  If  there  is  one  solution,  that  solution  is  analyzed  to  com- 
pute the  impulsive  Av  and  time  interval  At  before  execution.  If  there 
are  two  solutions,  the  minimum  velocity  correction  magnitude  solution 
is  computed  for  execution. 


If  there  are  no  solutions  the  desired  orbit  Is  modified  to  obtain 
a tangential  solution.  Three  modifications  (see  Figure  4.8)  are  investi- 
gated: 

1)  Vary  r^  while  holding  r&  at  desired  value 

2)  Vary  r&  while  holding  r^  at  desired  value 

3)  Vary  a while  holding  e at  desired  value 


Figure  4. 8 


Coplanar  Orbit  Modifications 


The  details  of  the  computations  of  these  modifications  may  be  found 
in  the  analysis  of  COPINS.  Now  for  the  unweighted  errors  evaluate  the 
differences 


« - j Ar  | + |Arfl  j (4. 56) 

where  Ar  , Ar  denote  the  discrepancies  in  the  desired  and  modified  values 

p a 

of  r^  and  r^  respectively.  The  unweighted  errors  are  then  multiplied  by 
a weighting  factor  chosen  to  rate  the  preference  for  the  given  modifi- 
cation. The  first  option  requires  one  subsequent  orbit  trim  at  apoapsis 
to  trim  to  the  desired  orbit;  it  therefore  is  given  a weight  factor  W = 1. 

The  second  option  requires  a subsequent  trim  at  periapsis  which  is  a 
less  satisfactory  maneuver:  therefore  it  has  a weighting  factor  of  W = 2. 

The  third  option  requires  two  subsequent  maneuvers  at  both  periapsis  and 
apoapsis:  it  therefore  is  assigned  a weighting  factor  of  W = 3. 


After  evaluating  the  weighted  errors  of  each  of  the  maneuvers,  the 
minimum  one  is  selected  for  the  actual  insertion  execution, 

4.  5.  3 Nonplanar  Strategy 

The  analytic  details  of  the  nonplanar  orbit  insertion  strategy  are 
given  in  the  analysis  of  subroutine  NONINS.  The  overview  of  this 
strategy  will  be  discussed  here. 

The  target  parameters  prescribed  under  this  option  are  the  angles 
specifying  the  desired  plane  in  target  body  equatorial  coordinates: 
the  inclination  i and  the  right  ascension  Q.  The  orientation  of  the 
ellipse  within  the  plane  is  fixed  by  the  specification  of  the  argument 
of  periapsis  co.  Nominal  values  for  the  semimajor  axis  a and  eccentricity 
e are  also  read  in;  however  these  are  altered  during  the  course  of  the 
insertion  decision  to  obtain  an  impulsive  solution.  These  parameters 
are  illustrated  in  Figure  4.  9. 


Figure  4.  9 Orientation  of  Desired  Orbit 


Now  suppose  that  the  approach  hyperbola  intersects  the  desired  plane 
at  two  points  A and  B.  The  probability  is  that  neither  A nor  B lie  on 
the  desired  ellipse.  Thus,  the  desired  ellipse  must  be  varied  to  allow 
the  intersection  of  those  points. 


The  geometry  within  the  plane  of  the  desired  ellipse  is  indicated 
in  Figure  4. 10.  For  each  of  the  points  A and  B three  modifications  of 
the  desired  orbit  are  made: 

1)  Vary  r holding  r fixed 

a p 

2)  Vary  r^  holding  r^  fixed 

3)  Vary  a holding  e fixed 
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A 


Figure  4.10  Nonplanar  Orbit  Insertion  Modifications 


Then  loss  functions  are  assigned  to  each  of  the  solutions  according 
to 


* = WMWR  (jArJ  +|Arp!)  (4.57) 

where  Ara  and  Ar  are  the  differences  in  periapsis  and  apoapsis  radii 

from  their  desired  values.  is  a weighting  function  equal  to  the  index 

of  the  modifications  listed  above  indicating  the  preferences  for  the 
modifications.  W is  a weighting  factor  to  encourage  the  choice  of  a 

solution  on  the  incoming  ray  (W  = 1)  over  the  outgoing  ray  = 2) . 

K K. 

The  solution  with  the  minimum  £ is  then  selected  for  the  execution  of 
the  insertion  maneuver. 

The  states  on  the  hyperbola  (r  , v ) and  the  modified  ellipse 
«s>  n n 

(rej  v ) at  the  selected  intersection  point  are  then  computed  and  used 
to, determine  the  insertion  Av 

Av  = v^  - vT  (4,  58) 

eh 

and  time  before  excutionAt. 
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4.6  Thrusting  Arc  Modeling 
4.6.1  Introduction 

The  result  of  the  midcourse  correction  targeting  event  is  the  velocity 
increment  Av  which  must  be  added  impulsively  to  the  current  nominal  state 
(r,  v)  in  order  to  yield  a trajectory  satisfying  given  target  conditions. 

If  the  midcourse  correction  is  to  be  executed  impulsively  on  the 
nominal,  the  state  immediately  following  the  maneuver  is  given  by 


■*+  •*- 
r = r 

v+  = v + Av  (4.  59) 

The  midcourse  may  also  be  executed  by  an  alternative  technique  known  at 
the  thrusting  arc  model. 

The  thrusting  arc  is  intended  to  add  to  STEAP  the  capability  to 
model  pulsing  type  radial  engines.  The  radial  engine  is  mounted  on  a 
spin- stabilized  spacecraft;  thrusts  are  added  periodically  as  the  space- 
craft rotates  into  the  proper  direction.  Thus,  the  velocity  corrections 
are  added  as  a series  of  pulses  over  an  extended  time  interval. 

The  order  of  magnitude  of  parameters  is  such  that  a maneuver  may  require 
up  to  a thousand  pulses  over  a ten  day  interval. 

The  general  scheme  for  the  transformation  of  the  impulsive  velocity 
increment  into  an  equivalent  series  of  pulses  is  indicated  in  Figure  4. 11. 
The  impulsive  correction  Av  is  divided  into  a number  of  equal  pulses  Av^ 

all  in  the  same  direction  as  Av  and  with  the  sum  of  their  magnitudes  equal 
to  the  magnitude  of  the  single  impulse  Av. 


Figure  4. 11  Thrusting  Arc  Modeling 
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4.6.2  Computation  of  Sequence 


Suppose  that  the  targeting  event  has  generated  the  required  impulsive 
velocity  correction  Av.  The  problem  then  becomes  to  determine  a sequence 
of  bounded  pulses  Av^,  such  that  the  net  effect  of  adding  these  pulses 
sequentially  over  a time  interval  is  equivalent  to  adding  the  single 
increment  Av  impulsively. 

The  procedure  used  in  STEAP  proceeds  as  follows.  Introduce  the 
engine  parameters 

T Thrust  magnitude  of  single  pulse 

m Nominal  mass  of  spacecraft 

At  Duration  of  single  pulse 

i 

At^  Time  interval  between  successive  pulses 
The  velocity  increment  imparted  by  a single  pulse  is 


Av 


i 


TAt 

m 


The  number  of  pulses  required  then  is 


(4.  60) 


N 

P 


+1 


(4.61) 


where  £*]  denotes  the  greatest  integer  function.  The  magnitude  of  the 
final  pulse  must  be  adjusted  to  insure  that  the  sum  of  magnitudes  Is 
correct.  Thus,  the  final  pulse  Av^  is  set  to 


Av^  = Av  - (N  - 1)  Av.  (4.62) 

t p L 

■i 

The  nominal  pulse  of  the  sequence  Av^  and  the  final  pulse  in  the 
sequence  Av^  are  forced  to  have  the  same  direction  as  tie  original  impul- 
sive increment 


Av 

Av 


Av^^  *=  Av^ 


r“  A Av 

Avf  Avf  r. 


(4.63) 


The  time  interval  of  the  pulsing  arc  is  then  given  by 


AT  = (N  - 1)  At 
P 


(4.64) 


4.6.3  Perturbed  Heliocentric  Propagation 


Because  of  the  large  number  of  pulses  possible  in  a single  maneuver, 
it  i s expedient  to  determine  an  efficient  means  of  propagating  the 
ballistic  trajectory  between  pulses.  A perturbed  heliocentric  propagator 
(PERHEL)  including  the  effects  of  the  sun  and  the  launch  and  target 
bodies  was  developed. 


The  equations  of  motion  of  a 
the  sun  and  a perturbing  body  may 


body  moving  under  the  influence  of 
be  written 


h(r  - r ) 
1 m 


3 

r 

m 


(4.65) 


where 


r is  the  vector  radius  from  the  sun  to  the  spacecraft 

r^  is  the  vector  radius  from  the  sun  to  the  perturbative  mass 

p are  the  gravitational  constants  of  the  sun  and  mass  respectively 

The  last  term  in  (4.65)  representing  the  indirect  force  is  discarded 
as  being  insignificant  at  this  point.  Conic  formulae  are  used  to  determine 
the  state  r^,  v^  at  the  end  of  the  interval  At  ignoring  the  second  term. 

This  is  simply  heliocentric  conic  propagation  then.  Perturbations  result- 
ing from  the  second  term  of  the  right  hand  side  of  (4.65)  are  then  brought 

in.  The  assumption  is  made  that  the  vector  r - r is  linear  in  time  over 

m 

the  interval  At 


r - r = At  + B 
m 


(4.66) 
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With  this  assumption  the  perturbation  equations  may  be  solved  in 
closed  form  for  the  direct  term  perturbations  5r,  5v„  The  state  at  the 
end  of  the  interval  is  then  given  by 


x c = x r + bx 
f of 


v c + 6v 
of 


(4,67) 


The  detailed  derivation  of  these  equations  are  given  in  PERHEL.  In 
the  actual  program  the  direct  term  perturbations  for  both  the  launch 
and  target  bodies  are  added  to  the  final  solution. 

Investigating  of  equation  (4, 66)  indicates  that  some  way  of  pro- 
pagating the  launch  and  target  bodies  over  the  given  interval  must  be 
available.  To  do  this  the  f and  g series  (see  PREPUL)  for  both  the 
launch  and  target  planets  are  evaluated  at  the  nominal  time  of  correction. 
The  position  of  the  target  planet  at  some  point  At  relative  to  that  time 
is  then  given  by 

rT  (&t)  = fT  (At)  rT  (0)  + gT  (At)  vT  (0) 

6 

fT  (t)  = E fktk  (4.68) 

k=0 

8T  = E 8kfck 

k=0  R 

with  similar  equations  for  the  launch  body, 

4.6.4  Execution  of  Sequence 

The  actual  propagation  of  the  spacecraft  through  the  series  of  pulses 

may  now  be  explained.  The  state  of  the  spacecraft,  the  launch  planet 

and  the  target  are  all  recorded  at  the  nominal  time  of  the  correction  t . 

o 

The  thrusting_arc  parameters  given  by  (4, 60)  to  (4. 64)  are  computed  for 
the  required  Av.  The  positions  of  the  launch  and  target  bodies  are  com- 
puted at  the  beginning  of  the  thrusting  arc  t„ 

D 


t 


B 


t 

o 


AT 

2 


(4.69) 


The  spacecraft  is  then  propagated  backwards  to  t using  the  perturbed 

D 

heliocentric  propagator  PERHEL.  The  nominal  pulse  of  the  arc  is  then 
added  impulsively 

(rB,  vB+)  = (?B,  v“  +Avi)  (40  70) 

The  positions  of  the  launch  and  target  bodies  an  interval  At^ 

later  are  computed  and  the  spacecraft  is  propagated  over  that  interval 
by  PERHEL.  This  process  is  repeated  until  the  final  pulse  Av^  is  added. 

The  final  spacecraft  state  relative  to  the  sun  and  the  updated  time 
t H — - are  then  sent  to  the  trajectory  mode  to  continue  the  n-body  pro- 
pagation from  the  end  of  the  thrusting  arc. 
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5. 


ERRAN  ANALYSIS 


5o I General  Description  of  ERRAN 

The  error  analysis  program  ERRAN  is  a preflight  mission  analysis  tool 
and  is  concerned  primarily  with  the  propagation  of  covariance  matrices 
along  selected  interplanetary  or  lunar  trajectories.  All  random  variables 
are  assumed  to  have  gaussian  distributions,  and  linear  theory  is  assumed 
for  the  propagation  of  all  covariance  matrices. 

There  are  three  main  quantitative  results  that  come  from  the  error 
analysis  program,  all  of  which  are  very  important  for  trajectory  design 
during  preflight  mission  analysis.  The  first  output  is  the  orbit  deter- 
mination or  navigation  uncertainty  at  selected  trajectory  times.  The 
processed  (know ledge)  covariance  matrix  of  orbit  determination  uncertainty 
gives  a probabilistic  answer,  for  a specific  reference  trajectory,  to  the 
question  "how  well  will  the  actual  trajectory  be  known  after  optimal 
processing  of  the  tracking  information?"  The  error  analysis  program  can 
be  used  to  study  the  effects  of  dynamic  model  errors,  sensor  errors,  and 
measurement  schedules  and  types  on  the  orbit  determination  process. 

A second  result  obtained  from  the  error  analysis  program  is  equally 
important.  Orbit  determination  uncertainties , although  they  are  signifi- 
cant, do  not  by  themselves  answer  all  the  pertinent  questions  related  to 
mission  success.  Another  question  that  must  be  answered  is,  "how  close 
will  the  actual  trajectory  come  to  meeting  the  specified  target  conditions?" 
Because  of  injection  errors  and  dynamic  model  errors  the  actual  trajectory 
will  depart  from  the  original  targeted  nominal  trajectory.  The  statistical 
measure  of  such  dispersion  is  represented  by  the  control  covariance  matrix 
which,  unlike  the  knowledge  covariance  discussed  above,  is  unaffected  by 
the  processing  of  tracking  information.  The  propagation  of  this  control 
covariance  forward  to  the  target  will  provide  us  with  probabilistic  infor- 
mation relating  to  target  miss  in  the  absence  of  midcourse  guidance 
corrections.  However,  a midcourse  guidance  correction  can  be  performed 
to  reduce  the  actual  trajectory  dispersion  about  the  target.  Propagation 
of  the  sum  of  the  knowledge  covariance  and  the  guidance  execution  error 
covariance  forward  from  the  midcourse  correction  time  to  the  target  will 
provide  us  with  probabilistic  information  relating  to  target  miss  follow- 
ing a midcourse  guidance  correction. 

The  third  main  result  from  the  error  analysis  program  is  concerned 
with  the  probabilistic  determination  of  likely  fuel  budgets  required  for 
interplanetary  or  lunar  missions.  Without  performing  any  estimation,  the 
most  likely  magnitudes  of  the  mrdcourse  correction  magnitudes  can  be  computed 


along  with  their  variances.  This  computation  permits  the  mission  analyst 
to  calculate  reasonable  fuel  loading  requirements  that  are  critical  in 
the  design  of  an  actual  system. 

Two  matrix  quantities  are  carried  throughout  the  error  analysis 
program.  One  is  the  nominal  or  reference  state  vector,  which  is  needed 
for  many  computations,  and  the  second  is  the  covariance  matrix  of  navi- 
gation uncertainties  associated  with  the  state  vector.  The  state  vector 
is  comprised  of  spacecraft  position  and  velocity  plus  any  augmentation 
parameters  included  in  the  analysis.  The  covariance  matrix  is  a square, 
symmetric,  positive  definite  matrix  of  associated  uncertainties  whose 
dimension  corresponds  to  that  of  the  state  vector. 

The  computational  operation  of  the  error  analysis  program  may  be 
separated  into  two  distinct  calculation  procedures.  The  first  of 
these  is  called  the  basic  cycle  and  refers  to  the  process  of  propagating 
uncertainties  from  one  measurement  to  the  next.  A Kalman  recursive  fil- 
tering algorithm  with  a consider  option  is  used  to  process  the  measurement 
and  compute  the  state  vector  associated  covariance  matrix  that  begins  the 
next  step  in  the  basic  cycle.  Events  refer  to  computations  in  the  error 
analysis  program  that  are  not  simply  propagations  of  the  navigation  un- 
certainty covariance  matrix  from  one  measurement  to  the  next  and  subse- 
quent optimal  filtering  of  the  new  measurement.  In  the  error  analysis 
program,  three  kinds  of  events  are  permitted. 

The  three  events  allowed  in  the  error  analysis  program  are  eigen- 
vector events,  prediction  events,  and  guidance  events.  At  an  eigenvector 
event,  the  position  and  velocity  covariance  matrix  partitions  are 
diagonalized  to  reveal  geometric  information  about  the  size  and  orienta- 
tion of  the  position  and  velocity  navigation  uncertainties.  At  a pre- 
diction event,  the  most  recent  covariance  matrix  is  propagated  forward 
to  some  critical  trajectory  time,  usually  a guidance  correction  time,  to 
determine  predicted  orbit  determination  uncertainties  in  the  absence  of 
further  measurements.  When  a guidance  event  occurs,  a rather  lengthy 
computational  process  determines  the  likely  magnitude  of  the  guidance 
correction  together  with  execution  error  statistics  based  on  an  underlying 
physical  model  for  the  correction  process.  An  option  is  also  available 
for  computing  bias  aimpoints  and  bias  velocity  corrections  to  satisfy 
planetary  quarantine  constraints  at  each  midcourse  guidance  event.  Orbital 
insertion  guidance  events  are  also  available. 

The  next  section  of  this  chapter  details  the  Kalman  recursive  esti- 
mation algorithm  that  is  assumed  to  be  the  underlying  orbit  determination 
procedure.  Section  5.3  discusses  dynamic  and  measurement  noise  covariance 
matrices.  Section  5.4  treats  the  methods  used  in  the  error  analysis 
program  for  computing  state  transition  matrices.  Section  5.5  presents 
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the  equations  required  for  the  computation  of  observation  matrices  for 
each  type  of  measurement.  Finally,  section  506  discusses  eigenvector 
and  prediction  events.  The  guidance  event  is  not  covered  in  chapter  5. 

See  chapter  7 for  a comprehensive  treatment  of  the  guidance  event. 

5. 2 Recursive  Estimation  Algorithm 

The  recursive  estimation  algorithm  refers  to  the  computational 
procedure  which  combines  dynamic  model  and  measurement  information  to 
generate  estimates  of  spacecraft  position  and  velocity  deviations  from 
the  nominal  trajectory,  estimates  of  certain  dynamic  and  measurement 
parameters,  and  the  knowledge  covariances  associated  with  these  estimates. 
The  error  analysis  program  treats  the  estimation  process  in  an  ensemble 
sense.  Only  the  knowledge  covariances  are  generated  in  ERRAN,  and  not  the 
estimates  themselves.  The  Kalman  recursive  estimation  algorithm  with  a 
consider  option  is  modeled  in  the  STEAP  programs.  But  before  presenting 
this  estimation  algorithm,  the  linear  dynamic  and  observation  models  will 
be  described. 

The  linearized  system  is  assumed  to  be  described  by  the  augmented 
state  vector 
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x = 


x 
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u 


V 


(5.1) 


where 


x = spacecraft  position/ velocity  state  (dimension  6) 
x^  = solve-for  parameter  state  (dimension  n^) 

u » dynamic  consider  parameter  state  (dimension  n£) 

v = measurement  consider  parameter  state  (dimension  n^) 

All  the  above  state  vectors  represent  deviations  from  nominal  state  vectors 
and  all  parameters  are  assumed  to  be  constant.  The  distinction  between 
solve-for  and  consider  parameters  will  be  clarified  subsequently. 


The  linearized  dynamic  model  is  assumed  to  have  form 
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where  * ^k+l»  tk^’  °xx  ^k+l’  Ck*  * and  ®xu  ^k+l’  fck^ 


are  state  transition  matrices  over  the  time  interval  ^t^,  tk+lJ  re''-at*-nS 

changes  in  x,  x , and  u,  respectively,  at  time  t,  to  changes  in  x at 
S K 

time  The  variable  represents  the  effect  of  dynamic  noise  over 

the  interval. 


The  linearized  observation  model  is  assumed  to  have  form 


= Vk + V,.  + Vk + Vk  + ”k  C5- 3) 

k 

where  observation  matrices  H^,  G^,  and  relate  changes  in  x,  xg , 

u,  and  v,  respectively,  to  changes  in  the  observable  y.  All  observation 
matrices  are  evaluated  at.  the  nominal  condition.  The  variable  r;  repre- 
sents measurement  noise. 

Under  the  usual  assumption  of  white  noise,  the  dynamic  and  measurement 
noise  statistics  are  described  by 

E [qk]  = E D?k]  - 0 

E tvp  ■ \ V 

E M]  * \ v 

The  equations  constituting  the  recursive  estimation  algorithm  are 
of  two  types:  state  estimation  equations  and  knowledge  covariance  equa- 

tions. Only  the  latter  will  be  presented  below.  The  state  estimation 
equations  will  be  presented  in  chapter  6. 
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An  estimation  algorithm  with  no  consider  option  treats  all  assumed 
dynamic  and  measurement  parameters  as  "solve-for"  parameters,  i.e.,  the 
estimation  algorithm  generates  estimates  of  the  parameters  as  well  as 
estimates  of  the  spacecraft  position  and  velocity.  Continued  processing 
of  measurements  will  often  reduce  knowledge  covariances  to  unrealistically 
low  values,  a situation  which  can  induce  divergence  in  the  estimation 
algorithm.  Divergence  iB  said  to  occur  when  the  actual  estimation  error 
grows  without  bound.  One  method  used  to  prevent  divergence  is  to  incor- 
porate a consider  option  into  the  algorithm  and  divide  all  assumed  para- 
meter into  either  solve-for  or  consider  parameters.  Consider  parameters 
are  not  estimated  by  the  algorithm,  nor  can  their  knowledge  covariances 
be  reduced  by  measurement  processing.  In  essence,  by  not  solving  for  all 
parameters  in  the  assumed  parameter  set  the  algorithm  acknowledges  the 
fact  that  its  assumed  set  of  dynamic  and  measurement  parameters  do  not 
fully  describe  the  real  world,  and  that  it  is  impossible  to  reduce  para- 
meter uncertainties  indefinitely. 

The  knowledge  covariance  for  the  augmented  state  is  defined  as 


(5.4) 


where  x indicates  estimated  values  and  x indicates  actual  values.  In- 
troducing equation  (5.1)  into  equation  (5.4)  and  expanding  the  result 
permits  us  to  write  the  covariance  matrix  in  the  following  partitioned 
form; 
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Covariance  matrix  partitions  P,  P^,  U^,  and  Vq  are  all  symmetric  and 

represent  the  covariances  of  the  spacecraft  position/velocity  state, 
solve-for  parameters,  dynamic  consider  parameters,  and  measurement 
consider  parameters,  respectively.  The  off-diagonal  covariance  matrix 
partitions  represent  the  correlations  between  the  two  variables  indicated 
by  the  subscripts.  Thus,  C represents  the  correlation  between  solve- 

s 

for  parameters  and  dynamic  consider  parameters. 

The  assumptions  implicit  in  the  consider  option  entail  that  co- 

variances  U and  V remain  constant  with  time.  Estimates  u and  v are 
o o 

always  zero.  Although  the  consider  option  does  not  require  it,  it  is 
realistic  to  assume  no  correlation  between  dynamic  consider  parameters 
and  measurement  consider  parameters  exists,  so  that  C is  always  zero. 


The  covariance  equations  involved  in  the  estimation  algorithm  are  of 
two  types:  prediction  equations  and  filtering  equations.  The  prediction 

equations  describe  the  behavior  of  the  covariance  matrix  partitions  as  they 
are  propagated  forward  in  time  with  no  measurement  processing.  The  filtering 
equations  define  the  covariance  updating  procedure  whenever  a measure- 
ment is  processed.  Details  of  their  derivation  can  be  found  in  reference 
10. 


The  prediction  equations  are  summarized  below: 
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(5.10) 
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A minus  superscript  on  covariance  partitions  indicates  the  covariance 
partition  immediately  prior  to  processing  a measurement;  a plus  super- 
script, immediately  after  processing  a measurement. 

The  filtering  equations  involve  equations  for  the  measurement 
residual  covariance  matrix  Js  Kalman  gain  matrices  K and  S,  and  covar- 
iance updating.  The  measurement  residual  covariance  matrix  is  given  by 

Jk+1  = \+l  \+l  + \+l  \+l  + Gk+1  \+l  * \+l  Elc+1  + \+l  <‘5ol3) 
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The  Kalman  gain  matrices  for  both  position/ velocity  state  and  solve- 
for  parameters  are  given  by 


Kk+1  “ Ak+1  ''k+1 

(5.14) 
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The  covariance  partitions  immediately  after  processing  a measurement 
are  given  by 
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(5.  22) 


It  should  be  noted  that  the  covariance  matrices  themselves  are  not 
printed  out  in  STEAP.  Rather,  all  variances  appearing  along  the  diagonal 
of  the  augmented  covariance  matrix  defined  by  equation  (5.5)  are  con- 
verted to  standard  deviations  and  all  off-diagonal  covariances  are  con- 
verted to  correlation  coefficients.  Thus,  if  covariance  a is  an  element 
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of  the  augmented  covariance  matrix,  then  the  correlation  coefficient  is 
given  by 
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ij 


Jl  "j 
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1/2  1/2 

where  standard  deviations  a ^ and  a are  given  by  cr^  = a^  and  o\  = aj  j • 

Following  these  transformations  all  standard  deviations  and  correlation 
matrix  partitions  are  then  printed  out. 


5. 3 Dynamic  and  Measurement  Noise  Covariance  Matrices 


The  problem  of  filter  divergence  has  been  mentioned  in  the  previous 
section  in  connection  with  the  consider  option.  The  basic  cause  of 
divergence  is  modeling  insufficiency  and  many  separate  categories  of  this 
insufficiency  can  be  enumerated.  The  causes  of  the  divergence  problem 
and  possible  solutions  to  it  are  given  in  greater  depth  in  the  analytical 
discussion  of  the  simulation  program.  The  purpose  of  including  a dynamic 
noise  matrix  Q in  the  error  analysis  program  is  to  examine  the  effect  of 
dynamic  model  insufficiency  on  the  key  outputs  of  the  error  analysis  program. 
Some  dynamic  or  unmodeled  noise  always  corrupts  an  interplanetary  trajectory; 
what  is  interesting,  from  the  point  of  view  of  the  error  analysis  program, 
is  how  the  primary  quantitative  outputs  are  affected  by  various  levels 
of  dynamic  noise. 

The  dynamic  noise  model  used  in  the  error  analysis  program  is 
somewhat  arbitrary  and  its  interpretation  is  difficult.  Over  any  time 
interval  At  between  measurements,  the  dynamic  noise  matrix  Q is  computed 
from  three  input  constants  that  remain  the  same  throughout  a trajectory 
run.  These  three  constant  inputs  K^s  and  K^,  whose  units  are  km^/sec  , 

roughly  correspond  to  variances  of  assumed  unmodeled  accelerations.  The 
dynamic  noise  matrix  Q added  over  any  interval  At  is  diagonal.  Specifically, 
if  At  is  the  interval  between  measurements,  the  six  nonzero  terms  of  Q are 
given  by 
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K2At‘ 


Q66  = 


K3At' 


Some  explanation  of  this  form  for  the  dynamic  noise  is  necessary. 

It  was  decided  early  in  the  design  of  the  program  that  the  physical  inter- 
pretation of  arbitrary  dynamic  noise  must  be  made  possible  by  relating 
the  Q matrix,  in  some  fashion,  to  unmodeled  accelerations.  Similarly,  it 
appeared  that  the  magnitude  of  the  dynamic  noise  should  be  a function  of 
the  specific  time  interval  over  which  it  was  added;  in  other  words,  the 
dynamic  noise  added  when  two  days  were  between  measurements  should  be 
greater  than  that  added  when  only  two  hours  separated  the  two  measurements. 


The  first  attempt  to  satisfy  these  two  constraints  resulted  in  the 
assumption  that  the  unmodeled  accelerations  could  be  represented  as  biases 
with  zero  mean  and  variances  K- , K , K . Consider,  for  example,  a vector 

• • •#  ••  1*  & mJ 

random  variable  (6X,  5Y,  5Z)  with  variances 


= K 


3 


and  correlation  coefficients  set  equal  to  zero.  If  these  accelerations 
represent  biases,  then  over  any  interval  At  they  are  related  to  position 
and  velocity  uncertainties  through 


5X  = «X  (At);  6X  = j (SX)  <ftt)2 

and  similarly  for  the  other  components.  Under  this  model  for  the  dynamic 
noise,  the  Q matrix  would  be  the  same  as  that  given  in  equation  (5.23) 
except  for  the  completely  correlated  off-diagonal  terms  resulting  in 

Q14  " 2 K1  At  » Q25  = 2 K2  At  * Q36  = 2 K3  At 
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Clearly,  If  the  unmodeled  accelerations  are  indeed  bias.es,  the  5X 

and  uncertainties  due  strictly  to  the  dynamic  noise  must  be  completely 

correlated* 

This  initial  model  for  the  dynamic  noise  was  unsatisfactory  for 
two  reasons*  First,  the  resulting  error  analysis  was  forced  to  assume 
that  the  unmodeled  acceleration  was  a constant  bias  throughout  the  tra- 
jectory  as  well  as  over  each  interval.  The  physics  of  the  problem  suggests 
that  unmodeled  accelerations  are  probably  constant  biases  over  short 
periods,  but  over  an  entire  trajectory  they  probably  vary  considerably. 
Secondly,  if  the  values  for  Kj  are  large  enough  for  the  dynamic  noise  to 

significantly  affect  the  processed  covariance  matrices,  their  total 
correlation  induces  an  unrealistically  high  correlation  between  the  same 
terms  in  the  resulting  uncertainty  matrices. 

A more  careful  modeling  of  the  stochastic  process  was  discarded 
due  to  the  arbitrary  nature  of  the  Q matrix.  The  dynamic  noise  matrix 
was  chosen  as  in  equation  (5. 23)  because  uncoupling  the  position  and 
velocity  uncertainties  due  to  unmodeled  accelerations  retained  a physical 
feel  for  the  meaning  of  Q and  permitted  its  computation  to  be  viewed  as 
a combination  of  random  and  bias  error  in  the  unmodeled  accelerations. 

The  measurement  noise  covariance  matrix  R requires  little  comment. 

We  simply  assume  the  measurement  noise  for  each  measurement  type  has 
constant  statistics,  and  hence  constant  covariance  matrix  R,  for  a given 
mission. 

5.4  State  Transition  Matrices 

State  transition  matrices  describe  the  dynamic  behavior  of  linear 
systems.  Before  presenting  the  different  techniques  that  are  available 
in  the  STEAP  programs  for  computing  state  transition  matrices,  the 
derivation  of  the  general  form  of  the  linear  system  modeled  in  STEAP 
will  be  summarized. 

The  nonlinear  equations  describing  the  motion  of  the  spacecraft 
have  form 


X = f (X,  W,  t)  (5.24) 

where  X denotes  the  spacecraft  position/velocity  state  and  W is  a vector 
of  dynamic  parameters  which  define  the  dynamic  model.  The  linearized 
version  of  equation  (5.24)  is  given  by 


(5.  25) 


k 


where  x and  w represent  linear  deviations  from  nominal  states  X and  W, 
respectively.  Partial  derivative  matrices  ^ and  ^ are  evaluated  along 
the  nominal  state. 


The  discrete  solution  of  equation  (5.  25)  over  the  time  interval 

[V  \+i]  18  8lven  by 


*k+l  ^k+l’  V *k  + ° ^k+l  * V Wk  (5.26) 

where  state  transition  matrices  t^)  and  0(t  t^)  are  required 

to  define  the  solution.  In  STEAP  the  parameter  deviation  vector  w is 
assumed  to  be  constant.  By  dividing  parameters  into  solve-for  and  con- 
sider parameters,  we  could  expand  equation  (5.26)  into  equation  (5.2). 

Three  methods  are  available  in  STEAP  for  computing  the  6x6  state 
transition  matrix  <$>.  The  first  two  methods,  which  are  analytical  methods, 
are  analytical  patched  conic  and  analytical  virtual  mass.  The  third 
method  uses  numerical  differencing  to  compute  <$>.  In  the  analytical  tech- 
niques it  is  assumed  that  the  spacecraft  trajectory  is  a two-body  conic 
section  over  a small  time  interval,  and  that  perturbations  about  the 
nominal  trajectory  can  be  related  by  using  the  basic  analytical  two-body 
matrizant.  To  increase  the  accuracy  of  these  analytical  techniques  over 
longer  time  intervals  a state  transition  matrix  cascading  option  is  pro- 
vided in  STEAP  (see  subroutine  CASCAD  analysis  for  more  details). 

In  the  present  version  of  STEAP  the  state  transition  matrix  0,  re- 
lating parameter  deviations  to  position/velocity  deviations,  is  always 
computed  using  the  numerical  differencing  technique. 

5.4.1  Analytical'  Patched  Conic 

The  basic  idea  in  using  an  analytic  patched  conic  state  transition 
matrix  is  that  over  a small  time  interval  of  an  interplanetary  flight, 
the  motion' of  a spacecraft  is  essentially  a two-body  conic  section. 

Based  on  the  foregoing  assumption,  Danby  (ref.  6)  has  developed  a set  of 
general  equations  for  determining  the  state  transition  matrices  by  the 
use  of  matrizants.  The  matrizant  of  two-body  motion  is  used  in  STEAP 
for  both  analytical  methods  of  computing  state  transition  matrices. 

The  basic  fundamentals  and  equations  of  Danby' s method  will  be  presented 
here.  Complete  derivations , are  given  in  reference  5. 
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Letting  x(t)  represent  a column  vector  composed  of  position  and 
velocity  deviations  at  time  t,  x(tQ)  the  same  for  time  tQ,  and  g the 

deviation  of  a set  of  six  geometrical  elements,  an  equation  that  relates 
small  deviations  in  position  and  velocity  at  two  different  times  can  be 
written  as 

x(t)  = M(t)g  = M(t)M  1 (tQ)  x (tQ)  (5.27) 

Thus,  the  state  transition  matrix  is  given  by 

<S>(t,  tQ)  = M(t)M_1  (tQ)  (5.28) 

The  reference  coordinate  system  considered  here  has  the  X-axis  pointing 
toward  periapsis  for  the  conic,  the  Z-axis  along  the  angular  momentum 
vector,  and  Y forming  the  triad.  Danby  (ref.  5)  calls  this  the  "orbital 
reference  system" . 

The  geometrical  orbital  elements  defined  by  g may  be  set  in  a column 
vector  as, 

'biQ  + r,Sr 
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where  / is  the  mean  anomaly  at  an  arbitrary  epoch 5 a is  the  semimajor 
axis  of  the  orbit;  e is  the  eccentricity  of  the  orbit;  5p,  5q,  and  5r 
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are  infinitesimal  rotations  about  the  reference  axis;  h is  the  angular 
momentum  per  unit  mass;  and  n is  the  mean  motion  of  the  orbit.  The 

2 1/2 

auxiliary  parameter  r)  is  defined  by  (1  - e ) . Avoiding  the  algebraic 

manipulations,  the  resultant  M matrix  as  given  by  Danby  (ref  5)  has  the 
following  form. 
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(5.  30) 


where  X,  Y,  and  Z are  the  components  of  position  and  velocity  along  the 
particular  orbit,  t is  some  specified  epoch,  and  the  accelerations  are 
given  by 


3* 

R3  ’ 


= ZHl 

3 ’ 3 

R R 


2 2 2 1/2 

R is  the  magnitude  of  the  position  deviation  represented  by  (X  + Y + Z ) ' 
and  p is  the  gravitational  constant  of  the  dominant  body  used  in  the  two- 
body  approximation. 


The  inverse  of  the  M matrix  at  the  initial  time  t is  given  by 


M-1  (tQ)  = A7MT(t)  7T 


(5.  31) 


where  A is  a diagonal  matrix  of  dimension  6x6  and  has  diagonal  components 
(a/p,  a/ph,  1/h,  a/p,  a/ph,  1/h).  7 is  given  as  the  matrix 

-I 

7 

0 

with  I being  the  identity  matrix  of  appropriate  dimension. 
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The  state  transition  matrix  that  relates  perturbations  about  some 
nominal  state  vector  between  two  arbitrary  times  can  now  be  determined 
by  combining  equations  (50 30)  and  (5.31).  The  resulting  matrix  is  referenced 
to  the  orbit  plane  coordinate  system  and  thus,  because  all  computations  in 
STEAP  are  performed  in  the  ecliptic  frame,  a rotation  needs  to  be  included 
so  that 


$ (t 


s ^o^ecliptic  orbit  plane 


where  R is  the  rotation  matrix. 


(5.  32) 


In  using  the  foregoing  method  for  analytical  patched  conic  deter- 
mination of  the  state  transition  matrices,  an  automatic  check  is  made 
in  the  program  to  determine  what  sphere  of  influence  the  vehicle  is 
in  at  the  time  of  computation.  The  sphere  of  influence  determines  what 
gravitational  mas3  and  dominant  body  location  will  be  used  to  compute 
the  matrizant.  It  should  be  stressed  that  the  particular  gravitational 
constant  being  used  at  the  time  of  computing  <$>  is  chosen  at  the  beginning 
of  the  time  interval.  In  other  words,  If  a check  is  made  at  t^  and  the 

sphere  of  influence  is  that  of  the  Sun  and  the  trajectory  at  t^  is  inside 

the  sphere  of  influence  of  the  target  planet,  then  jig  will  be  used  in 

the  algorithm.  No  significant  problems  have  resulted  by  using  this 
approximate  strategy,  primarily  because  most  of  the  time  intervals  are 
small  when  state  transition  matrices  are  computed  near  the  spheres  of 
influence. 


The  method  of  computing  state  transition  matrices  by  the  analytical 
patched  conic  technique  is  assumed  in  the  program  unless  otherwise 
specified  by  the  input. 

5.4.2  Analytical  Virtual  Mass 

Computation  of  state  transition  matrices  by  the  analytical  virtual 
mass  technique  is  similar  to  the  patched  conic  method.  The  same  general 
equations  developed  by  Danby  (ref.  5)  are  also  used  in  determining  state 
transition  matrices  using  the  virtual  mass  concept. 

The  virtual  mass  technique  requires  that  the  location  and  magnitude 
of  the  virtual  mass,  as  calculated  by  the  virtual  mass  subroutine,  be 
stored  for  use  in  the  computation  of  <£>.  Once  the  computational  intervals 
and  values  for  the  location  and  magnitude  of  the  virtual  mass  have  been 
determined  for  the  nominal  trajectory  these  same  quantities  are  used  to 


generate  the  state  transition  matrix.  Hence,  after  determining  the 
nominal  trajectory,  the  nominal  state  vector  X(t)  is  available  along 
with  a set  of  values  r^ (t)  and  pv(t)  representing  the  position  and 

magnitude  of  the  virtual  mass. 

Ajs  mentioned  previously,  the  equations  for  the  two-body  matrizant  are 
also  employed  in  this  second  method  of  computing  the  state  transition  matrix. 
However,  now  the  dominant  body  is  assumed  to  be  the  effective  force  center. 
Recall  that  in  the  analytic  patched  conic  method,  a check  was  made  to  deter- 
mine what  sphere  of  influence  the  vehicle  was  in  at  the  beginning  of  the  time 
interval.  In  using  virtual  mass  concepts  to  compute  the  state  transition 
matrices,  a sphere  of  influence  check  is  avoided.  When  calling  the  state 
transition  matrix  module,  the  gravitational  parameter  of  the  virtual  mass  ^ 

v 

is  used  instead  of  the  ji  of  the  dominant  body.  The  location  of  the 
virtual  mass  is  likewise  used  in  the  determination  of  0 under  this  method. 


5.4.3  Numerical  Differencing 


The  method  used  to  compute  <i>  and  0 using  numerical  differencing 
will  be  presented  in  this  section.  Consider  first  the  computation  of 
<J>.  Let  fj(t^+^,  t^)  represent  the  j-th  column  of  ^(tk+^,  t^).  We 

assume  we  have  available  nominal  states  X^  and  To  obtain  f 

we  increment  the  j-th  element  of  X^  by  the  numerical  differencing  factor 

AXj  and  numerically  integrate  equation  (5.24)  over  the  time  interval 

ft^,  t^J  to  obtain  the  new  spacecraft  state  X^+^.  (The  j-superscript 

indicates  Xj^+^  was  obtained  by  incrementing  the  j-th  element  of  X^. ) Then 


■j  (tk+l  ’ V 


4*1 


X. 


k+1 


Ax. 


(5.  33) 


j = 1>  2,  . . . 6 

The  computation  of  0 is  quite  similar.  Let  represent  the  j-th 
column  of  9(t^+^,  t^).  Again  we  assume  nominal  states  X^  and  X^+^  are 
available.  To  obtain  £ we  increment  the  j-th  element  of  the  parameter 
vector  W by  the  numerical  differencing  factor  Aw^  and  numerically  inte- 
grate equation  (5. 24)  over  the  time  interval  [t^,  t j]  to  obtain  the 
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j 

new  spacecraft  state 


Then 
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*£+1  - X' 


k+1 


Aw 


(5.  34) 


j 1,  2,  ...  t n^ 

where  n^  is  the  number  of  dynamic  parameters 0 
5.5  Observation  Matrices 

Observation  matrices  relate  deviations  in  spacecraft  position/ 
velocity  state  and  deviations  in  dynamic  and  measurement  parameters 
from  nominal  values  to  deviations  in  observables  from  their  nominal 
values.  Before  discussing  the  observation  or  measurement  types  avail- 
able in  STEAP  and  the  technique  used  to  construct  observation  matrices, 
the  derivation  of  the  linearized  observation  equation  will  be  summarized. 

The  general  nonlinear  observation  equation  has  form 


Y = f(X,  W,  t)  (5.35) 

where  Y denotes  the  observable,  X denotes  the  spacecraft  position/ 
velocity  state,  and  W is  a vector  of  dynamic  and  measurement  parameters. 
The  linearized  version  of  equation  (5. 35)  is  given  by 


(5.  36) 


where  y,  x,  and  w represent  deviations  from  nominal  Y < 
respectively,  and  partial  derivative  matrices 

and  are  evaluated  at  the  nominal  condition. 


X,  and  W, 


If  we  partition  the  parameter  vector  w into  a solve-for  parameter 
vector  xg,  a dynamic  consider  parameter  vector  u,  and  a measurement 
consider  vector  v,  then  equation  (5.  36)  can  be  written  as 


y — Hx  + Mxg  + Gu  + Lv 


(5.  37) 
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where  we  have  defined  H = and  partitioned  ^ into  three  sub-matrices 

M,  G,  and  L.  Adding  measurement  noise  to  this  equation,  we  would  obtain 
equation  (5.  3) . 


Two  categories  of  observables  or  measurements  are  available  in 
STEAP:  earth-based  range  and  range-rate  measurements  and  onboard  optical 

measurements.  Earth-based  range  and  range-rate  measurements  can  be  taken 
from  4 tracking  stations,  one  of  which  is  an  idealized  station  located 
at  the  center  of  the  earth,  while  the  remaining  three  can  be  positioned 
at  arbitrary  locations  on  the  surface  of  the  earth.  The  relevant  geometry 
for  such  measurements  is  depicted  in  Figure  5.1.  The  X,  Y,  Z coordinate 
system  represents  the  inertial  ecliptic  coordinate  system,  which  can 
be  centered  at  the  Sun  or  the  barycenter  according  to  the  nature  of  the 


Figure  5. 1 Earth-based  Tracking 


mission.  The  x,  y,  z coordinate  system  represents  the  geocentric  equatorial 
coordinate  system.  Axis  x is  always  aligned  with  axis  X.  The  rotation 
of  this  coordinate  system  relative  to  the  X,  Y,  Z system  is  defined  by 
e , the  obliquity  of  the  ecliptic.  The  states  of  the  spacecraft  and  the 
Earth  relative  to  inertial  space  are  given  by  X and  Xg,  respectively.  The 

tracking  station  state  relative  to  the  center  of  the  Earth  is  denoted 
by  Xg.  The  geographical  location  of  the  station  is  defined  by  radius 

R D | X | , latitude  0,  and  longitude  0„  Longitude  0 is  measured  positive 

b 

east  from  the  Greenwich  meridian.  The  hour  angle  of  Greenwich  is  denoted 
by  GHA.  Finally,  the  position  of  the  spacecraft  relative  to  the  tracking 
station  is  given  by  the  vector  p.  The  scalar  observables  are  range,  also 
denoted  by  p,  and  range-rate  p„ 

Onboard  optical  measurements  modeled  in  STEAP  are  3 star-planet  angle 
measurements  and  an  apparent  planet  diameter  measurement.  The  relevant 
geometry  for  such  measurements  is  depicted  in  Figure  5. 2.  The  position 


Figure  5.2  Onboard  Tracking 
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of  the  target  planet  center  relative  to  the  spacecraft  is  denoted  by  the 
vector  p.  Target  planet  radius  is  given  by  R . The  star-planet  angle 

a is  defined  to  be  the  angle  between  p and  the  spacecraft/ star  line  of 
sight.  The  locations  of  three  arbitrary  stars  are  modeled  in  STEAP. 

The  apparent  planet  diameter  measurement  is  indicated  by  the  angle 

The  nonlinear  observation  equations  for  all  the  measurement  types 
discussed  above  are  summarized  in  the  subroutine  TRAKS  analysis  section. 
Also  presented  there  are  expressions  for  the  partial  derivatives  required 
to  construct  the  observation  matrix  partitions  H,  M,  G,  and  L. 


5.6  Eigenvector  and  Prediction  Events 


At  an  eigenvector  event  we  simply  transform  the  knowledge  or  navi- 
gation uncertainty  covariance  matrix  P into  useful  geometrical  information, 
which  includes  eigenvalues,  eigenvectors,  and  hyperellipsoids.  Define  t^ 

as  the  time  of_the  last^  processed  measurement  before  the  eigenvector 
event  and  let  and  P^  be,  respectively,  the  nominal  trajectory  and  the 

orbit  determination  uncertainty  covariance  matrix  after  processing  th«5 
measurement  at  t^.  If  t^  is  the  time  of  the  eigenvector  event,  then  X^, 

the  nominal  state  vector  at  t y is  computed  from  the  virtual  mass  tra- 
jectory subroutine.  The  navigation  uncertainty  covariance  matrix  at  t^ 
defined  by  P^  is  given  by  equation  (5.6)  with  subscript  k+1  replaced  by  j. 

All  state  transition  matrix  partitions  are  understood  to  be  defined  over 
the  time  interval  [t^>  t^J. 


The  eigenvalues,  eigenvectors,  and  hyperellipsoid  could  be  obtained 
for  the  6 x 6 Pj  matrix,  but  their  geometrical  interpretation  is  diffi- 
cult. If,  instead,  we  operate  on  the  3x3  position  and  velocity  parti- 
tions of  Pj  we  can  obtain  geometrical  information  which  is  both  useful 

and  readily  interpreted. 


Let  P^  and  P^  denote  the  position  and  velocity  partitions,  respectively, 

of  covariance  P..  Then  at  an  eigenvector  event  these  partitions  are 

diagonalized  to  produce  position  and  velocity  eigenvalues  and  eigenvectors. 
The  principal  axis  associated  with  the  minimum  eigenvalue  defines  the 
direction  of  minimum  uncertainty;  the  axis  associated  with  the  maximum 
eigenvalue  defines  the  direction  of  maximum  uncertainty.  The  method 
employed  is  described  in  more  detail  in  the  subroutine  JACOBI  analysis 
section.  Next,  la  or  3 a (or  both)  hyperellipsoids  of  uncertainty,  in 


both  position  and  velocity  space  are  computed  to  show  the  size  and 
geometric  orientation  of  the  navigation  uncertainties.  These  el- 
lipsoids are  then  projected  onto  each  of  the  two-dimensional  planes 
to  show  additional  geometric  information.  The  analytical  details 
of  this  procedure  are  presented  in  the  subroutine  HYELS  analysis 
section . 


At  a prediction  event  at  time  t_.  , the  nominal  trajectory  X_. 
and  associated  knowledge  covariance  are  first  computed  just  as 
at  an  eigenvector  event.  Now  define  t as  the  time  to  which  the 
prediction  is  being  made.  Then  the  knowledge  covariance  at  t^, 
assuming  no  measurements  over  the  time  interval  [ t ^ , t ],  can  be 
computed  using  equation  (5.6)  with  t,  = t . and  t = t . 

K.  J K.T  i P 


Within  the  prediction  event  algorithm  of  the  error  analysis 
program,  the  resulting  covariance  matrix  P^  at  the  prediction  time 

is  also  diagonalized  to  produce  eigenvector,  eigenvalue,  and  hyper- 
ellipsoid information.  Thus,  by  superimposing  this  geometrical 

information  about  P for  different  prediction  event  times  t.,  one 

P J 

can  observe  the  effect  of  additional  tracking  on  predicted  naviga- 
tion uncertainties. 


If  time  t occurs  inside  the  target  planet  sphere  of  influence, 
P 

Cartesian  position  and  velocity  uncertainties  are  transformed  to 
uncertainties  in  the  B-plane  parameters  B*T,  B*R,  S*R,  and  S*T, 
time  of  flight  t^,  and  energy  C^.  In  addition,  the  B-T,  B-R  co- 

variance  matrix  is  diagonalized  and  the  maximum  and  minimum  eigen- 
values are  computed.  The  square  roots  of  the  maximum  and  minimum 
eigenvalues  can  be  identified  with  the  (lo)  uncertainties  in  the 
semimajor  axis  SMAA  and  the  semiminor  axis  SMIA,  respectively,  of 
the  uncertainty  ellipse  in  the  B-plane.  The  orientation  of  this 
ellipse  in  the  B-plane  is  also  computed.  The  analytical  details 
of  this  procedures  are  presented  in  the  analysis  sectors  of  sub- 
routines PRESIM,  BEPS,  and  BPLANE. 
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6. 


SIMUL  ANALYSIS 


6.1  General  Description  of  SIMUL 

There  is  an  essential  difference  between  the  philosophies  governing 
the  error  analysis  and  simulation  programs  of  STEAP.  The  error  analysis 
program  is  primarily  a preflight  mission  analysis  tool  that  gives  informa- 
tion related  to  uncertainties  about  some  specified  nominal  trajectory.  By 
contrast,  the  simulation  program  is  designed  for  a detailed  analysis  of 
the  orbit  determination  procedure  and  its  efficacy  in  the  presence  of  a 
host  of  possible  anomalies.  The  error  analysis  program  might  be  used  to 
determine  the  nominal  trajectory  design  for  a specific  mission;  the  simu- 
lation program  then  "flies"  the  mission,  within  the  computer,  and  can 
provide  invaluable  information  for  mission  operations. 

The  computational  structure  of  the  simulation  program  is  similar  to 
that  of  the  error  analysis  program.  There  is  a basic  cycle  in  which  sub- 
sequent measurements  are  processed  consecutively  and  there  are  events  where 
calculations  not  specifically  related  to  the  measurement-processing  cycle 
are  made.  Section  6.2  outlines  in  detail  the  equations  and  logic  used 
within  the  basic  cycle  of  the  simulation  program.  In  section  6.3  eigen- 
vector, prediction,  and  quasi-linear  filtering  events  are  treated.  Finally, 
section  6.4  includes  a discussion  of  the  problems  of  divergence  and  non- 
observability that  can  plague  an  orbit  determination  procedure.  The 
guidance  event  is  not  covered  in  chapter  6,  but  is  treated  in  chapter  7 
together  with  the  error  analysis  guidance  event. 

The  computations  themselves,  within  the  simulation  mode,  are  not  any 
more  difficult  than  in  the  error  analysis  mode.  There  are,  however,  many 
more  of  them  and  in  the  discussion  to  follow  some  of  the  most  important 
features  of  the  simulation  program  will  be  discussed. 

6.2  The  Basic  Cycle 

Recall  that  in  the  error  analysis  program  only  two  quantities,  the 
targeted  nominal  state  vector  X and  the  knowledge  covariance  matrix  P, 
were  carried  along  through  each  step  in  the  basic  cycle.  Within  the 
simulation  program  there  are  six  key  quantities  carried  from  step  to  step 
in  the  basic  cycle.  These  six  quantities  are  summarized  below: 

Targeted  nominal  position/velocity  state  vector 
at  time  t,  ; updated  at  each  guidance  event. 

K. 

Most  recent  nominal  position/velo^city  state 
vector  at  time  • ; differs  from  after  a 
quasi-linear  filtering  event  that  updates 
the_s,tate  vector  by  the  estimate;  identical 
to  X^  immediately  after  a guidance  event. 


!>  Kk 
2>  \ 
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Actual  position/velocity  state  vector  deviation 
from  most  recent  nominal  state. 

Estimated  position/velocity  state  vector 
deviation  from  most  recent  nominal  state. 

Estimated  solve-for  parameter  deviations 
from  nominal  parameter  values. 

Knowledge  covariance  matrix  after  processing 
all  measurements  up  to  and  including  time  t „ 

See  section  5.2  for  definitions  of  the  whole 
set  of  knowledge  covariance  matrix  partitions 
which  are  carried  from  step  to  step  in  the 
basic  cycle. 

The  basic  cycle  of  the  simulation  program  refers  to  the  computational 

process  by  which  all  of  the  above  quantities  are  propagated  from  time 

t^  (which  may  or  may  not  have  been  a measurement  time)  to  the  next 

measurement  time  t^  and  updated  after  the  measurement  is  processed. 

We  assume  no  events  occur  between  t,  and  t,  , . . 

k k+1 

Before  proceeding  with  a step-by-step  discussion  of  this  basic  cycle, 
it  is  worthwhile  to  point  out  that,  unlike  the  error  analysis  program, 
the  simulation  program  is  involved  in  actually  processing  data  to  estimate 
an  interplanetary  or  lunar  trajectory.  Some  "actual"  trajectory  is  being 
flown  within  the  computer  and  simulated  measurements  from  Earth-based 
tracking  stations  are  recorded,  based  upon  this  "actual"  trajectory. 

These  measurements  are  then  processed  in  a recursive  estimation  algorithm; 
thus  the  simulation  program  provides  a check  of  the  orbit  determination 
procedure's  ability  to  reproduce  the  "actual"  trajectory  under  a wide  set 
of  conditions  that  might  be  anticipated  on  an  actual  mission. 

The  structure  of  the  basic  cycle  in  the  simulation  program  is  depicted 
in  figure  6.1  and  shows  the  basic  division  within  the  simulation  program 
between  the  modeled  world  and  the  real  world..  The  modeled  world  consists 
of  equations  and  parameters  which  are  assumed  to  describe  the  motion  of 
the  spacecraft  and  the  generation  of  observations.  It  also  consists  of 
assumed  spacecraft  injection  statistics  and  assumed  measurement  noise 
statistics.  Of  necessity  the  modeled  world  always  differs  from  the  real 
world.  The  actual  equations  governing  the  spacecraft  motion  are  never 
completely  known.  Dynamic  and  measurement  parameters  can  never  be  known 
exactly.  Non-zero  injection  errors  always  occur.  Actual  measurement 
noise  statistics  can  only  be  approximated.  The  whole  purpose  of  the 
simulation  program  is  to  provide  a tool  to  study  the  effects  of  modeled 
world/real  world  differences  on  the  navigation  process.  The  same  philosophy 
underlies  the  treatment  of  the  guidance  event  in  the  simulation  program 
(see  chapter  7) . 


6Xk,  or  xk 


4)  6 X,  , or  x 


5)  5Xs  , or  xg 
k k 


6)  P, 
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Figure  6.1  will  be  used  as  a guide  in  the  following  discussion  of 
the  computational  flow  in  the  basic  cycle.  It  should  be  pointed  out  that 
figure  6.1  has  been  simplified  somewhat  for  the  sake  of  clarity  and  does 
not  show  all  the  details  of  the  basic  cycle.  For  example,  only  the  first 
member  of  all  partitioned  matrices  is  shown.  We  assume  all  required 
quantities  are  available  at  time  t,  and  that  the  next  measurement  occurs 
at  time  t.  1 • The  first  step  in  the  basic  cycle  is  to  propagate  the  most 

recent  nominal  spacecraft  state  forward  to  t^^  using  assumed  dynamic 

parameters  and  a nominal  integration  accuracy.  Although  not  shown  in 

figure  6.1,  the  targeted  spacraft  state  is  also  propagated  forward  to 

t,  . in  the  same  way. 
k+1 

The  next  steps  in  the  SIMUL  basic  cycle  are  the  same  as  those  in 

the  basic  cycle  of  the  error  analysis  program.  State  transition  and 

observation  matrix  partitions  are  computed,  as  are  the  assumed  dynamic 

noise  and  measurement  noise  covariance  matrices.  Next,  the  knowledge 

covariance  prediction  and  filtering  equations  given  in  section  5.2  are 

evaluated  to  determine  the  reduction  in  all  knowledge  covariance  matrix 

partitions  following  the  processing  of  the  measurement.  It  should  be 

pointed  out  that  the  measurement  residual  covariance  matrix  J,  , , defined 

k+1’ 

by  equation  (5.13),  is  very  important  in  what  is  known  as  adaptive  filter- 
ing, a topic  to  be  discussed  in  section  6.4  of  this  chapter.  An  extension 
of  the  current  program  to  permit  the  use  of  adaptive  filtering  would  not 
be  difficult. 

We  turn  next  to  the  generation  of  the  actual  spacecraft  state  at 
time  t^^.  The  same  virtual  mass  subroutines  are  used  to  compute  the 

actual  trajectory,  except  now  different  dynamic  parameters  are  used.  For 
example,  different  values  for  the  gravitational  constants  of  the  Sun  and 
the  target  planet  could  be  used.  The  target  planet  ephemerides  could  be 
changed.  Also,  a different  number  of  celestial  bodies  could  be  used  in 
the  generation  of  the  actual  trajectory,  as  well  as  a different  integration 
accuracy.  Returning  from  the  virtual  mass  subroutines,  we  have  available 
a quantity  which  would  be  the  actual  state  at  t^^  if  there  were  no 

tsnmedeled  accelerations  acting  on  the  spacecraft  over  the  time  interval 
[tfcs  • However,  the  simulation  program  permits  constant  unmodeled 

accelerations  to  act  on  the  spacecraft  over  this  time  interval  which 
integrate  into  a state  vector  addition  w.  . . The  actual  state  and  the 

actual  state  deviation  from  the  most  recent  nominal  are  then  given  by 
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Unmodeled  accelerations  are  permitted  to  corrupt  the  actual  state 
vector  for  a very  definite  purpose.  Along  an  interplanetary  flight, 
many  possible  sources  of  mechanical  difficulty  onboard  the  vehicle  could 
give  rise  to  small  accelerations.  It  is  important,  for  the  purposes  of 
the  simulation,  to  determine  how  the  orbit  determination  algorithm  reacts 
in  the  presence  of  small  accelerations  about  which  the  algorithm  itself 
has  no  specific  knowledge. 


Another  digression  concerning  the  underlying  philosophy  of  the 
simulation  program  is  now  warranted.  Recall  that  its  purpose  is  essen- 
tially to  test  a specific  navigation  and  guidance  process,  insofar  as 
is  possible,  under  real  conditions.  Four  key  assumed  statistical  descrip- 
tions are  used  by  the  estimation  algorithm  to  produce  the  optimal  estimate 
of  the  state  vector.  These  four  are  in  injection  covariance  P^,  the 


dynamic  noise  covariance  Q^,  the  measurement  noise  covariance  R^,  and  the 

midcourse  correction  execution  error  covariances  . All  of  the  matrices 

represent  assumed  errors  and  their  probabilistic  descriptions.  Obviously 
the  convergence  of  the  estimated  trajectory  to  the  actual  trajectory, 
for  a real  flight,  is  a function  of  the  accuracy  of  these  a priori 
statistics.  To  test  the  orbit  determination  and  guidance  process  within 
the  simulation  program,  actual  injection  errors  , actual  midcourse 
execution  errors,  actual  unmodeled  accelerations,  and  actual  measurement 
noise  statistics  R,  may  be  specified  by  the  user.  These  specifications 
permit  the  study  of  the  effect  of  bad  a priori  statistics  on  the  success 
of  the  defined  navigation  and  guidance  algorithms. 


The  next  step  in  the  SIMUL  basic  cycle  is  concerned  with  the  genera- 

tion  of  the  actual  measurement  Y,  . . Referring  to  figure  6.1,  it  is 

tC"T  J-  ^ 

apparent  that  the  actual  measurement  provides  the  recursive  estimation 

algorithm's  only  contact  with  the  real  world.  All  other  inputs  to  the 

estimation  algorithm  are  computed  on  the  basis  of  the  modeled  world.  To 

compute  the  actual  measurement  we  first  determine  the  ideal  measurement 

Y.  ,,  which  would  be  made  for  the  actual  spacecraft  state  in  the  absence 
•mc+1 

of  all  sensor  errors.  The  equation  defining  Y^+^  has  form 
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where  X,  is  the  actual  spacecraft  state  and  p denotes  a vector  of 
k+1 

actual  dynamic  and  measurement  parameters.  Then,  assuming  the  actual 

sensor  error  to  be  the  sum  of  a bias  b,  and  a random  noise  v , we 

k+1  k+1 

compute  the  actual  measurement  from 
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(6.4) 


The  random  noise  V is  obtained  by  randomly  sampling  the  actual  measure- 
ment noise  covariance  matrix  R.  , , . 

—k+1 

The  estimation  algorithm  operates  on  the  measurement  residual 

€ , , , where  g,  ,,  is  defined  as 
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and  Y,  , , is  the  estimated  value  of  the  measurement.  To  compute  Y,  , 
k+1  r k+1 

we  first  determine  the  ideal  measurement  Y,  , which  would  be  made  if  the 

k+1 

spacecraft  were  actually  located  at  the  most  recent  nominal  state 
The  equation  defining  Y^+^  has  form 


k+1 


P, 


(6.6) 


where  p denotes  a vector  of  assumed  or  nominal  dynamic  and  measurement 
parameters.  Of  course,  the  estimated  spacecraft  state  does  not,  in 
general,  coincide  with  Further,  some  of  the  parameters  are  solve- 


for  parameters  which  are  being  estimated  along  with  the  spacecraft  state. 

The  estimated  measurement  Y,  reflects  these  estimated  deviations  and 

k+1 


is  given  by 
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Observation  matrices  H,  . and  M,  are  defined  in  equation  (5.3).  Position/ 

K.'T  1 K.~r  JL 

velocity  deviation  estimate  SX,  . and  solve-for  parameter  deviation 

i»y  X 

estimate  5X  are  computed  using  the  prediction  equations 
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The  recursive  estimation  algorithm  now  has  available  all  the  inform- 
ation required  to  process  the  measurement  and  generate  new  estimates.  The 
Kalman  recursive  estimation  equations  are  given  by 
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where  Kalman  gain  constants  K^^  and  have  been  computed  previously 

using  equations  (5.14)  and  (5.15). 

The  SIMUL  basic  cycle  is  complete  with  the  computation  of  the  actual 

estimation  error  Se,  This  error  is  defined  as 

k+1 


S e 


k+1 


5$ 


k+1 


SX 


k+1 


(6.13) 


and  is  a pleasure  of  the  performance  of  the  recursive  estimation  algorithm. 
A similar  error  quantity  is  defined  for  the  solve-for  parameter  estimate. 
Divergence  is  said  to  occur  when  these  estimation  errors  grow  in  an  un- 
bounded fashion. 

6.3  Eigenvector,  Prediction,  and  Quasi-Linear  Filtering  Events 

Eigenvector  and  prediction  events  in  the  simulation  program  involve 
all  the  computations  which  are  performed  in  eigenvector  and  prediction 


events  in  the  error  analysis  program  (see  section  5.61.  In  addition,  the 
most  recent  nominal  X,  , the  actual  state  deviation  6X,  , and  the  estimated 

K.  K 

j\  A 

deviation  <5X,  and  5X  are  propagated  forward  from  time  t to  event  time 

rC  8 . iC 

k 

t..  These  operations  are  performed  by  using  equations  (6.1),  (6.2),  (6.9), 
and  (6.10)  with  t^^  = t..  Also,  covariance  matrix  partitions  are  propa- 
gated along  the  most  recent  nominal,  rather  than  along  the  targeted  nominal 
as  in  ERRAN. 


The  prediction  event,  as  it  is  treated  in  SIMUL,  differs  from  an 
ERRAN  prediction  event  in  one  other  respect.  In  addition  to  propagating 

the  time 


the  knowledge  covariance  matrix  partitions  forward  to  time  t , 

P 

/i  V * 

to  which  we  wish  to  predict,  the  estimated  deviations  6X . and  oX 

r j s 


are 


also  propagated  forward  to  t^.  Equations  (6.9)  and  (6.10)  are  used  for 
this  purpose  with  t^+^  = t . 


At  a quasi-linear  filtering  event  the  most  recent  nominal  trajectory 
is  updated  by  using  the  most  recent  estimate.  The  purpose  of  the  update 
is  to  combat  divergence  due  to  the  possible  invalidity  of  the  linearity 
assumption  that  is  the  basis  for  the  estimation  algorithm  being  used. 
Specifically,  updating  the  nominal  trajectory  results  in  better  computa- 
tions of  the  state  transition  and  observation  matrix  partitions  employed 
in  the  recursive  estimation  algorithm.  The  quasi-linear  filtering  event 
is  defined  only  in  the  simulation  program  since  actual  state  deviation 
estimates  must  be  available. 

Letting  t.  denote  the  time  of  the  quasi-linear  filtering  event,  and 
— ^ + 

using  ( ) and  ( ) notation  to  indicate  values  immediately  before  and 

after  the  event,  respectively,  the  primary  state  vectors  and  deviations 
in  the  simulation  program  are  updated  as  follows: 


r** 

X.  = X.  + 
J J 


/V 


A + 

ax; 

j 


0 


rsj 

ax.  = ax.  - 

J 2 


(6.14) 


X. 

2 


X. 

2 


Knowledge  covariance  matrix  partitions  do  not  change  across  a quasi-linear 
filtering  event  since  nothing  has  occurred  which  would  either  increase  or 
decrease  the  uncertainty  of  our  estimates.  Control  covariance  matrices, 
which  are  defined  in  chapter  7,  likewise  do  not  change  across  a quasi- 
linear  filtering  event.  Finally,  nominal  solve-for  parameter  state  vectors 
are  not  updated  at  a quasi-linear  filtering  event  since  all  parameters  will 
be  reasonably  well  known  initially. 

6.4  Divergence  and  Other  Problems 

One  of  the  purposes  of  creating  such  a detailed  and  extensive  simu- 
lation program  was  to  study  the  problem  of  filter  divergence.  The  problem 
of  divergence  in  a recursive  navigation  process  and  a companion  difficulty, 
computational  nonobservability,  are  the  subjects  of  this  section. 


Strictly  speaking,  when  divergence  occurs  in  a navigation  process, 
the  navigation  is  failing  to  navigate  properly.  The  phenomenon  of 
divergence  never  appears  in  an  error  analysis  program  because  no  actual 
estimation  is  taking  place  and  only  covariance  matrices  are  being  propagated. 
In  a computer  simulation  such  as  the  STEAP  simulation  program,  where  an 
"actual"  trajectory  is  being  flown  and  concurrently  estimated  by  a naviga- 
tion algorithm,  filter  divergence  refers  to  the  failure  of  the  estimated 
trajectory  to  converge,  within  reasonable  bounds  specified  by  the  covariance 
matrices,  to  the  "actual"  simulated  trajectory.  For  real-world  orbit 
applications,  where  the  actual  trajectory  is  never  known,  divergence  is 
occurring  when  tne  residual  difference  between  predicted  and  actual 
observation  vectors  becomes  increasingly  large. 


In  either  computer  simulation  or  a real  orbit  determination  procedure, 
divergence  in  the  recursive  filter  manifests  itself  as  a statistical  in- 
consistency between  the  measurement  residuals  and  the  filtering  algorithm. 


Recall  that  at  each  step  of  the  recursive  process,  the  matrix  J 


k+1 


is 


computed  (see  equation  (5.13)).  This  matrix  defines  the  a priori  statistics 

associated  with  the  measurement  residual  €,  ...  The  measurement  residual 

k+1 

6^^  should  represent  a sample  for  the  population  defined  by  When 

divergence  occurs,  a group  of  successive  residuals  appear  less  and  less 
likely,  statistically,  to  have  been  sampled  from  their  covariances  . 


To  illustrate  the  divergence  manifestation  In  terms  of  measurement 
residuals  inconsistent  with  their  a priori  covariances,  assume  that  a 
scalar  range-rate  measurement  is  being  taken  along  an  interplanetary  orbit. 
For  scalar  measurements,  the  matrix  is  a scalar  residual  variance, 

call  it  ^ . Suppose  that  for  the  first  two  hundred  measurements,  each 

measurement  residual  was  compared  to  its  statistical  variance  by  solving 
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for  the  value 
values  K . produced 

Suppose 

further  that 

a frequency  histogram  of 

Interval 

No. 
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Without  subjecting  the  above  data  to  a rigorous  chi-square  test  of 
hypothesis , it  should  be  clear  that  the  measurement  residuals,  each  of 
which  is  assumed  to  be  an  uncorrelated , Gaussian,  mean  zero  random 
variable,  are  more  or  less  consistent  with  their  statistics;  that  is, 
the  ensemble  values  for  the  measurement  residuals  look  reasonable  in 
terms  of  their  a priori  variances  used  within  the  estimation  algorithm. 

Now  suppose  that  the  next  nine  values  of  K , determined  in  the 

same  fashion  from  the  nine  measurements  following  the  two  hundredth, 
are  given  by  the  sequence 
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K207  = - 6'2 

202  = " 
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K208  " 7,1 

203  = 
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K209  * - 7-  8 

(6.16) 


From  the  underlying  assumptions  of  the  navigation  process,  each  of  these 
events,  taken  singly,  is  extremely  unlikely.  However,  the  sequence  of 
values  given  is  almost  totally  unlikely  and  should  represent  a dead 
giveaway  that  divergence  is  occurring.  Without  pursuing  the  mathematics 
too  far,  it  should  be  stressed  that  if  the  nine  values  given  in  equation 
(6.16)  were  supposedly  chosen  at  random  from  a normal  distribution  with 
near  zero  and  unit  variance,  the  governing  distribution  would  fail  every 
test  of  statistical  hypothesis.  Such  values  for  K_  indicate  that  some- 
thing in  the  estimation  process  is  definitely  wrong:  the  most  likely 

candidate  for  the  error  is  the  assumed  a priori  J ^ matrix  used  for 

weighting  by  the  estimation  algorithm. 


The  hypothetical  example  given  above  is  typical  of  the  divergence 
phenomenon  that  recurs  in  complex  orbit  determination  processes.  Often, 
the  process  converges  initially  and  then,  after  many  measurements  have 
been  taken,  divergence  begins.  A general  explanation  for  this  is  that 
the  covariance  matrices  associated  with  the  estimated  state  vector 
become  overly  optimistic  and,  subsequently,  tend  to  disregard  the  new 
measurement  data  in  the  weighting  process. 


The  general  cause  of  divergence  is  modeling  insufficiency.  For 
most  real  problems,  everything  about  the  dynamical  system  and  the 
observations  being  treated  by  the  filter  is  not  known  exactly.  Unless 
the  estimation  algorithm  acknowledges,  in  some  fashion,  the  incomplete 
understanding  of  the  governing  equations,  divergence  may  result.  A 
familiar  source  of  insufficient  modeling  is  the  dynamic  equations  them- 
selves. All  the  forces  acting  on  spacecraft  are  never  known  exactly. 

In  addition,  the  filtering  algorithm  operates  on  perturbation  equations 
resulting  from  a linearization  about  some  reference  dynamic  state.  Thus, 
the  procedure  is  working  with  approximate  equations  and  unless  dynamic 
noise  is  added  to  the  computational  algorithm,  the  Kalman  filter  "thinks" 
it  knows  the  exact  equations  of  motion,  whereas  in  reality  it  does  not. 

Divergence  can  also  result  from  other  model  inadequacies.  Among 
the  most  frequent  causes  are  failure  to  account  for  measurement  non- 
linearities  when  the  measurements  themselves  are  very  accurate,  neglect 
of  correlated  errors  between  sequences  of  measurements  taken  by  the  same 
instruments,  and  overly  optimistic  a priori  error  statistics  describing 


79 


the  measurement  noise.  Within  the  simulation  program  of  STEAP,  the 
effect  of  all  these  model  inadequacies  on  a specific  reference  trajectory 
can  be  tested. 

Many  possible  solutions  to  the  problem  of  divergence  have  been 
postulated  and  investigated.  Four  of  the  methods  of  divergence  prevention 
will  be  discussed  in  this  section.  These  methods  are  (1)  dynamic  noise 
covariance  modeling,  (2)  quasi-linear  filtering,  (3)  consider  mode 
filtering,  and  (4)  adaptive  filtering.  All  but  the  last  method  are 
available  in  the  simulation  program. 

In  an  earlier  section  of  this  report  the  modeling  of  a dynamic 
noise  matrix  Q was  discussed.  Between  measurements  in  the  estimation 

K. 

algorithm  of  STRAP,  the  state  vector  associated  covariance  matrix  is 
propagated  according  to  equation  (5.6).  The  Q matrix  appearing  In  this 
equation  increases  the  magnitude  of  the  key  diagonal  elements  in  the 
covariance  matrix.  Because  divergence  generally  occurs  when  the  state 
vector  associated  covariances  become  unduly  optimistic  and  additional 
measurements  are  weighted  very  slightly,  the  addition  of  Q represents 
an  attempt  to  systematically  downgrade  the  dynamics  information  in  favor 
of  the  measurements. 

Although  the  addition  of  a proper  Q matrix  will  impede  divergence, 
unless  its  size  is  determined  by  physical  considerations  it  can  also 
slow  convergence.  Most  often  the  Q matrix  is  somewhat  arbitrary  and  its 
exact  influence  on  the  estimation  algorithm  is  not  clearly  understood. 

Thus,  attempts  should  be  made,  based  on  the  modeling  for  a particular 
problem,  to  ensure  that  the  elements  of  Q are  realistic. 

A second  method  of  divergence  prevention  included  in  the  simulation 
program  is  the  method  of  quasi-linear  filtering.  The  fundamental  esti- 
mation process  assumes  that  variations  about  the  nominal  trajectory  and 
nominal  measurements  are  linear.  In  the  case  of  highly  accurate  measure- 
ments, which  is  usually  the  case  of  Interplanetary  spacecraft  tracked 
by  the  DSIF,  measurement  nonlinearities  become  significant  model  inade- 
quacies when  the  actual  trajectory  is  only  slightly  different  from  the 
nominal.  Quasi-linear  filtering  essentially  permits  more  accurate  com- 
putation of  state  transition  and  observation  matrices.  This  is  accomplished 
by  updating  the  most  recent  nominal  trajectory,  based  on  the  estimated  state 
vectors  coming  from  the  navigation  algorithm,  and  then  computing  both  the 
state  transition  and  observation  matrices  in  terms  of  linear  perturbations 
about  the  updated  nominal. 

Treatment  of  errors  in  dynamic  or  measurement  parameters  without 
actually  estimating  them  is  generally  called  consider  mode  filtering. 

This  is  the  third  method  of  divergence  prevention  available  in  STEAP. 


Consider  mode  filtering  acts  to  prevent  divergence  in  much  the  same  way 
as  does  dynamic  noise  covariance  modeling,  discussed  earlier.  The  con- 
sider parameter  covariance  matrices  are  not  influenced  by  measurement 
processing  and,  in  fact,  remain  constant.  Since  consider  parameter  co- 
variance  matrices  cannot  be  reduced,  the  effect  of  consider  mode  filter- 
ing is  to  create  a residue  of  uncertainty  which  can  never  be  eliminated 
from  the  assumed  dynamic  model.  This,  in  essence,  defines  a lower  bound 
for  the  position/velocity  covariance  matrix. 

Of  the  other  methods  for  handling  filter  divergence  that  have  been 
suggested  in  the  literature,  the  strongest  appears  to  be  adaptive 
filtering.  Reference  7 explains  the  theoretical  basis  for  several 
kinds  of  adaptive  filtering  schemes.  The  essential  idea  of  adaptive 
filtering  is  the  feedback  of  actual  measurement  residuals  into  the 
covariance  matrix  propagation  process.  Earlier  it  was  pointed  out  that 
a sign  of  filter  divergence  is  a statistical  inconsistency  between  the 
measurement  residuals  e anc*  assumed  a priori  covariance  matrices 

used  by  the  estimation  algorithm.  In  adaptive  filtering,  this  statis- 
tical inconsistency  is  used  to  change  the  assumed  a priori  statistics, 
on  both  the  dynamics  and  the  measurements  until  the  residuals  and  their 
updated  covariances  are  more  or  less  consistent.  Optimal  implementation 
of  adaptive  filtering  is  being  pursued  by  several  researchers  in  the  field. 

Another  problem  associated  with  interplanetary  orbit  determination 
that  can  be  studied  with  the  STEAP  simulation  mode  is  that  of  computational 
nonobservability.  Because  this  problem  threatens  to  occur  whenever 
strictly  Earth-based  tracking  is  being  used  to  determine  the  orbit  of  a 
spacecraft  around  the  Moon  or  another  planet,  it  warrants  attention. 

In  classical  batch-processing  algorithms,  observability  does  not 
exist  when  a key  matrix  inverse  used  to  determine  the  estimate  does  not 
exist.  In  a recursive  algorithm,  nonobservability  manifests  itself  when 
one  of  the  correlation  coefficients  relating  uncertainties  in  different 
elements  of  the  state  vector  has  unit  magnitude.  Physically  this  means 
that  the  navigation  process  cannot  observe  or  estimate  the  two  quantities 
that  are  either  positively  or  negatively  correlated  uniquely.  The  orbit 
determination  procedure  has  no  unique  convergence  in  this  case. 

When  the  correlation  coefficients  relating  uncertainties  in  two 
elements  of  the  state  vector  are  very  close  to  unity  in  magnitude,  then 
the  underlying  estimation  algorithm  is  very  unstable.  Although  theoreti- 
cally a unique  solution  still  exists,  any  model  inadequacies  can  produce 
wild  gyrations  in  the  estimated  solutions.  Preliminary  studies  with  STEAP 
of  orbit  determination  processes  using  Earth-based  tracking  for  spacecraft 
in  Moon  or  Mars  orbits  indicate  that  the  above  orbit  determination 
instability,  called  computational  nonobservability,  is  very  much  a real 
problem. 
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7.  GUIDANCE  ANALYSIS 


7.1  Introduction 

Of  the  many  types  of  events  available  in  the  STEAP  programs,  guidance 
events  are  by  far  the  most  complex.  The  purpose  of  Chapter  7 is  to  provide 
a comprehensive  and  unified  discussion  of  the  analytical  basis  for  all 
types  of  guidance  events  modeled  in  the  error  analysis  program  ERRAN  and 
the  simulation  program  SIMUL. 

Guidance  events  yield  much  useful  information  for  preflight  mission 
analysis.  Using  ERRAN  we  can  evaluate,  in  a statistical  sense,  the  efficacy 
of  the  guidance  process  in  achieving  desired  target  conditions.  Equally 
important  is  the  determination  of  the  statistical  AV  requirements  for 
the  mission.  Using  SIMUL  we  can  determine  the  effect  of  modeled  world/real 
world  differences  on  the  guidance  process.  Actual  A^  requirements  and 
actual  target  errors  can  be  computed  for  the  simulated  mission.  In  both 
ERRAN  and  SIMUL  the  coupling  of  the  guidance  and  navigation  processes  has 
been  carefully  modeled. 

Several  types  of  guidance  events  are  available  in  ERRAN  and  SIMUL. 

At  a midcourse  guidance  event  the  user  can  choose  from  three  midcourse 
guidance  policies:  fixed- time-of-arrival , two-variable  B-plane,  and  three- 
variable  B-plane.  The  midcourse  guidance  event  can  be  subjected  to  planetary 
quarantine  constraints.  Two  orbital  insertion  policies  are  available: 
coplanar  insertion  and  non-planar  insertion.  Options  are  also  available 
for  changing  target  conditions  in  mid- flight  and  re- targeting  the  trajectory 
using  nonlinear  techniques,  or  for  simply  applying  an  externally- supplied 
or  pre-computed  AV  at  some  arbitrary  time  along  the  trajectory.  Two 
thrust  models  are  available:  impulse  and  impulse  series. 


In  the  following  section  the  concept  of  control  covariance  will  be 
presented,  and  all  features  of  the  guidance  event  which  are  independent 
of  the  specific  guidance  policy  will  be  discussed.  Section  7.3  treats  the 
execution  error  model  employed  for  impulsive  AV's.  Section  7.4  treats 
both  linear  and  nonlinear  midcourse  guidance,  as  well  as  biased  aimpoint 
guidance,  which  is  required  to  satisfy  planetary  quarantine  constraints. 
All  remaining  guidance  event  options  are  discussed  in  section  7.5 

7.2  General  Analysis 


Most  variables  used  in  the  general  analysis  have  already  been  defined 
in  Chapters  5 and  6.  We  shall  assume  an  arbitrary  guidance  event  is  to  be 


executed  at  guidance  event  time  t 


In  the  following  analysis  the 


notation  ( ) , will  be  used  to  indicate  the  values  of  variables  immediately 


j 

prior  to  the  execution  of  the  event;  ( 


denoted  simply  by 
now  be  denoted  by 


+ 


immediately  after.  Although 


P in  Chapters  5 and  6,  the  knowledge  covariance  will 
to  distinguish  it  from  the  control  covariance  P 


Only  the  spacecraft  position/velocity  knowledge  and  control  covariance 
partitions  are  required  for  guidance  analysis,  although  the  entire  set 
of  covariance  prediction  equations  given  in  section  5.2  are  used  whenever 
covariances  matrices  are  to  be  propagated  over  some  interval  of  time. 

Before  proceeding  with  the  general  analysis  of  a guidance  event,  it 
is  necessary  to  digress  briefly  to  discuss  the  control  covariance  Pc  and 

how  it  differs  from  knowledge  covariance  Pv  . Recall  that  the  knowledge 

K. 

covariance  represents  the  statistical  dispersions  of  the  estimation  errors 
about  the  spacecraft  state  estimate  and  is  defined  as 


(7.1) 


where  estimation  error 


<5e  is  defined  as 


<5  e = 6 X - 6 x . 


(7.2) 


Here  OX  and  OX  denote  the  estimated  and  actual  deviations,  res- 
pectively, from  the  most  recent  nominal  trajectory.  Processing  of 
measurements  normally  reduces  the  knowledge  covariance,  which,  in  geo- 
metrical terms,  corresponds  to  a contraction  of  the  knowledge  covariance 
hyperellipsoid.  The  control  covariance  represents  the  statistical  dis- 
persions of  the  actual  trajectory  about  the  targeted  nominal  trajectory 
and  is  defined  as 


P 

c 


(7.3) 


where  6 X denotes  the  actual  deviation  from  the  targeted  nominal 
trajectory.  The  time  behavior  of  the  control  covariance  depends  solely 
on  modeled  spacecraft  dynamics  and  is  in  no  way  (except  at  a guidance 
event)  influenced  by  measurement  processing.  Control  covariances,  like 
knowledge  covariances,  are  propagated  across  an  interval  of  time  using 
the  covariance  prediction  equations  given  in  section  5.2.  However,  the 
covariance  filtering  equations,  which  are  also  presented  in  section  5.2, 
are  never  used  to  update  control  covariances.  Control  covarisnces  are 
used  in  both  ERRAN  and  SIMUL  to  predict  statistical  target  miss  dispersions. 
The  control  covariance  is  also  important  in  the  computation  of  statistical 
midcourse  guidance  corrections  in  ERRAN. 

We  return  now  to  the  discussion  of  a general  guidance  event.  At  each 
guidance  event  a commanded  velocity  correction  AV^  is  computed.  The 

nature  of  this  computation  is,  of  course,  policy-dependent  and  will  be 
treated  in  subsequent  sections.  In  general,  AV . will  be  a function 
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of  the  desired  target 
Except  when  midcourse 
sense,  as  they  are  in 

Otherwise,  only  the  s 


conditions  and  the  estimated  spacecraft  state, 
guidance  corrections  are  treated  in  an  ensemble 
ERRAN,  the  required  AV.  can  always  be  computed. 


tatistical  E 


AV 


;]■ 


avj 

can  be  computed. 


Due  to  execution  errors  the  actual  velocity,  correction  will  differ 
from  the  commanded  correction.  The  actual  velocity  correction  AV^  is 
given  by 


AV  . + 6 A V 

j j 


(7.4) 


where  $AV  is  the  execution  error.  The  guidance  process  acknow- 

j 

ledges  the  existence  of  an  execution  error  by  generating  the  assumed  stat- 
istics of  the  execution  error.  The  execution  error  is  assumed  to  have 

fO 

zero  mean  and  covariance  Q . , which  is  defined  as 


fU 


(7.5) 


Both  $AV.  and  Q.  are  generated  using  the  execution  error  model 
j J 

described  in  section  7.3. 

The  spacecraft  state,  estimated  deviations,  and  covariance  matrices 
are  altered  when  a guidance  event  is  executed.  The  remainder  of  this 
section  develops  all  the  equations  required  in  this  updating  process  for 
an  impulsive  velocity  correction.  If  the  velocity  correction  is  modeled 
as  an  impulse  series  the  modified  equations  presented  in  section  7.5.4 
define  the  updating  process. 

In  addition  to  the  assumption  of  an  impulsive  velocity  correction, 
we  also  assume  that  the  targeted  nominal  trajectory  is  updated  after  a 
guidance  correction.  This  is  a reasonable  assumption  and  permits  the 
simplification  of  the  control  covariance  update  equation.  The  targeted 
nominal  state  update  equation  is  given  by 


— + 
X. 

J 


“ . /■>  “ 

X + $x  + 
J J 


(7.6) 


where  X.  + 
J 


is  the  estimated  spacecraft  state  just  prior  to  the 


guidance  event.  Note  that  equation  (7.6)  also  defines  the  estimated  state 
immediately  following  the  guidance  correction.  Thus,  if  we  also  update 
the  most  recent  nominal  state  using  equation  (7.6),  then  the  estimated 
state  deviation  is  given  by 


(7.7) 


. a + 
axj 


0 . 


At  a guidance  event  our  estimation  error  §e  is  increased  by  the 
execution  error.  Thus 


where 


fix'-  Sx  " . 

J j 


(7.8) 


(7.9) 


The  minus  sign  appears  in  equation  (7.8)  since,  according  to  equation 
(7.4),  is  defined  as  the  actual  minus  the  estimate,  while  the 

estimation  error  de  is  defined  as  the  estimate  minus  the  actual.  Then 
the  new  actual  state  deviation  from  the  most  recent  nominal  is  defined  by 

6X.  = $X+-  $e  + (7.10) 

J J j 

Combining  equations  (7.7)  through  (7.10)  to  eliminate  all  ( ) quantities 

in  equation  (7.10)  yields 

dx  = 6x  - dx.  + 
i j J 


5AV 


(7.11) 


This  is  the  actual  state  deviation  update  equation. 

It  remains  to  develop  the  update  equations  for  the  knowledge  and 
control  covariance  matrices.  The  knowledge  covariance  immediately  following 
the  guidance  correction  is  defined  by 


(7.12) 


Substitution  of  equation  (7.8)  into  equation  (7.12)  readily  yields  the 
required  knowledge  covariance  update  equation: 


(7.13) 
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The  control  covariance  update  equation  is  also  easily  derived.  Sub- 
stitution of  equation  (7.7)  into  equation  (7.10)  yields 


6x 


+ 


+ 


(7.14) 


But  the  control  covariance  immediately  following  the  guidance  equation 
is  defined  by 


(7.15) 


Substitution  of  equation  (7.14)  into  equation  (7.15)  then  yields  the 
control  covariance  update  equation 


Pc+  - PK+  (7.16) 

j j 


All  the  update  equations  just  presented  are  used  in  the  simulation 
program  SIMUL.  The  error  analysis  program  ERRAN  treats  only  the  ensemble 
characteristics  of  the  navigation  and  guidance  processes  and,  as  such, 
does  not  generate  estimated  or  actual  state  deviations.  Thus,  the  state 
deviation  update  equations  are  undefined  in  ERRAN.  Only  X,  P,^,  and 

P are  updated  at  an  ERRAN  guidance  event.  The  latter  two  quantities 
are  updated  using  equations  (7.13)  and  (7.16),  respectively,  while  the 
targeted  nominal  is  updated  using 

X + = X ” + 

J J 


AV 


UP;  J 


(7.17) 


where  AV^  represents  the  non-statistical  component  of  . . 

. A 1 

When  AV^  is  wholly  statistical,  as  is  the  case  for  ERRAN  midcourse 

guidance  events  (with  no  aimpoint  biasing),  then  of  course  AV^p  Is 
zero  and  the  targeted  nominal  is  not  updated.  j 

7.3  Execution  Error  Model 


The  computation  of  the  actual  execution  error  $AV  and  the  execution 
error  covariance  matrix  Q is  based  on  an  execution  error  model  defined 
by  four  independent  error  sources.  The  first  error  source  is  called  the 
proportionality  error  and  is  in  the  direction  of  the  velocity  correction 


vector  AV  with  magnitude  determined  by  the  proportionality  factor  k. 

A second  error  source,  in  the  direction  of  AV  but  independent  of  its 
magnitude,  is  the  resolution  error  s that  corresponds  to  a thrust  tailoff 
error  from  the  engines.  Two  pointing  errors  defined  in  terms  of  angles 
6a  and  60  complete  the  error  model.  From  this  description  of  the  error 
model,  the  equation  for  <5AV  can  be  written  as 


<5AV 


k AV  + s AV 
I A V | 


+ <$  Av 


pointing 


(7.18) 


where  6 AV  . . is  defined  by  two  angular  pointing  errors,  da  and 

pointing  ° 

60  . 

For  purposes  of  unique  specification,  assume  that  6a  is  a pointing 
error  angle  measured  in  a plane  parallel  to  the  ecliptic  plane  and  along 
a vector  orthogonal  to  the  velocity  correction  vector  AV.  If  <5AV^ 

* A A A 

is  the  velocity  error  due  to  the  angular  pointing  error  da  and  i,  j,  k 
form  the  unit  triad  in  the  ecliptic  system,  then  for  small  angles  , 

6 AV  is  given  by 


6 = p6a 


Avy 

2 2 k 

(Ar  + avy  ) 


i - 


Avx 

(AV^  + Avy  ) h 


(7.19) 


where  AV^  and  AV^  are  the  X and  Y ecliptic  components  of  the 

velocity  correction  vector  AV  and  p is  the  magnitude  of  AV  . Note 
that  the  velocity  error  fiAV^  resulting  from  6a  has  components  only 

in  a plane  parallel  to  the  ecliptic. 


The  second  pointing  angle  60  defines  a velocity  error  6AV£  that 

is  orthogonal  to  both  6 A V^  and  the  velocity  correction  vector  A V . 

Again  for  small  angles  60,  the  velocity  error  resulting  from  this  pointing 
error,  referenced  to  the  ecliptic  system,  is  given  by 


6 Av2 


AVx  AVz  60  ^ , Avy  Avz  60  A 

(Av^  + avy)%  (Av£+avy)% 


60  ( Avx  + 


h 'N 


A V ) k 


(7.20) 
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From  these  equations  it  is  clear  that  the  vector  set  A.V , 8 AV^ 

and  5AV2  satisfies  the  mutual  orthogonality  imposed  by  the  model. 

The  complete  description  of  the  execution  error  vector  8 AV  may  then 
be  wrftten  in  ecliptic  coordinates  as 


<5AV  = 


r \ p Av  Sa  + AV  A vijj 

k + — I A v + X — X — - — 

1 P X u 


\ AV  AV  - P AV  6o< 

+ k + ■§  Av  + — X — X X — 

r I Y ii 


k + - AV  - u6/3 

P z 


(7.21) 


where  AV  > AV  , and  AV  are  the  ecliptic  coordinates  of  the 

Ai  Lt 

velocity  correction;  l,  j,  k are  unit  vectors  in  the  X,  Y,  and  Z 
directions;  p is  the  magnitude  of  A V;  k,  s,  8ct,  8 ft  are  the  four 
independent  error  sources;  and  u is  an  intermediate  variable  defined  by 


u = (AV*  + AV*)2 


(7.22) 


In  SIMUL  the  components  of  the  commanded  velocity  correction 

and  actual  values  of  the  errors  k,  s , 6 a , and  8 ft  are  used  to  evaluate 
equation  (7.21)  to  determine  the  actual  execution  error  5A^.  • Equation 
(7.21)  is  not  required  in  ERRAN.  j 


The  expression  for  the  execution  error  covariance  Q is  obtained 

j 

by  substituting  equation  (7.21)  into  equation  (7.5).  The  equations  which 
result  from  this  operation  are  summarized  in  the  subroutine  QC0MP  analysis 
and  will  not  be  presented  here.  However,  these  equations  have  form  given 
by 


Q . = Q.  ( AV,  o a , o a ) 

J J k s 5a  50 


(7.23) 


where  a 


through  a 


are  the  assumed  variances  for  the  four  error 


sources  which  define  the  error  model.  No  cross-correlations  appear  in 
this  equation  since  all  the  error  sources  are  assumed  to  be  independent. 
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In  SIMUL  the  components  of  the  commanded  velocity  correction  AV  are 

used  to  evaluate  equation  (7.23).  In  ERRAN  the  sum  of  the  statistical 
and  non-statistical  components  of  AV  are  used. 

j 

7.4  Midcourse  Guidance 

7.4.1  Linear  Midcourse  Guidance 


Linear  impulsive  midcourse  guidance  policies  have  form 


AV  = r a'  (7.24) 

j j j 

A 

where  AV  is  the  commanded  velocity  correction  required  to  null  out 
deviations'* from  the  nominal  target  state,  f is  the  guidance  matrix, 

J 

and  oX.  is  the  estimated  spacecraft  deviation  from  the  targeted  nominal 
trajectory  just  prior  to  the  guidance  correction. 

Three  midcourse  guidance  policies  are  modeled  in  ERRAN  and  SIMUL: 
fixed- time-of-arrival  (FTA) , two-variable  B-plane  (2VBP) , and  three-variable 
B-plane  (3VBP) . The  derivation  of  the  r matrix  for  each  policy  will 
be  summarized  below.  J 


The  variation  matrix  V relates  deviations  in  spacecraft  state 

j 

at  t.,  to  target  state  deviations.  If  T is  a vector  which  defines  the 
target  state,  then 


hr  = r)  6 X 
j j 


(7.25) 


For  FTA  guidance  the  target  state  T is  the  nominal  closest  approach 


position  vector 
deviations  at  t 


R^A  at  nominal  time  of  closest  approach 
are  related  to  state  deviations  at  t 


J 


CA 


tCA  . State 
by  the  equation 


5X  = 0(t  , t.) 

CA  CA  j 


5X 


(7.26) 


where  0 ^CA’  fcj^  :*'S  t*ie  state  transition  matrix  over 
t j , t^,A  j . Thus,  for  FTA  guidance  the  variation  matrix 


the  interval 
is  given  by 


89 


V,  = 

J 


(7.27) 


where  0 and  0^  denote  the  two  upper  3x3  partitions  of  . We  wish 
to  select  a AV^  such  that  $T  = 0 in  equation  (7.25).  Employing 
equation  (7.27),  this  condition  reduces  to  the  equation 


0 - j *2] 


A 

ax.  + 

0 

1 

j 

Lav.  . 

1 

which,  when  solved  for 


yields 


r -i  t i 

[“  *2  *1  i -1  J 


«X. 

J 


and 


(7.28) 


(7.29) 


where  tg^ 


The  target  state  for  3VBP  guidance  is  defined  as  T = £ B-T 
is  the  time  at  which  the  nominal  trajectory  pierces 


B-R,  tSI]  , 
the  sphere 


of  influence  of  the  target  planet.  The  variation  matrix  V cannot  be 

easily  defined  in  terms  of  a state  transition  matrix.  Instead,  a numerical 
differencing  technique,  which  is  described  in  the  subroutine  VARSIM  analysis 
section,  must  be  employed  to  construct  the  T]  , matrix.  Once  the  Tj  . 
matrix  is  available  we  can  write  ^ 


n ! n 1 

Lit  '21 


(7.30) 


and  proceed  along  the  lines  of  the  previous  FTA  derivation  to  obtain 


r 

3VBP 


-1 


(7.31) 


The  target  state  for  2VBP  guidance  is  defined  as  T = 

where,  in  contrast  to  3VBP  guidance,  no  time  constraint  is 
Target  deviations  are  related  to  state  deviations  at  tCT 

O x 


B-T,  B-R 


T 


imposed . 

by  the  equation 


ar  = m a xgi  . 


(7.32) 


90 


The  computation  of  the  matrix  M is  described  in  the  subroutine  PARTL 

analysis  section.  Since  iX_T  can  be  related  to  5X  using 

^ J-  J 


6X  = 0 (t  , t ) JX 
SI  SI  j j 


(7.33) 


it  is  easy  to  show  that  the  variation  matrix  is  given  by 


*?  = M 0 (t  t .) 

J SI  j 


(7.34) 


The  variation  matrix  will  be  partitioned  as  follows 


T).  = [a  | B 1 

J L i J 


(7.35) 


where  partitions  A and  B are  2x3  matrices.  We  wish  to  select  a 
AV.  such  that  5t  =0  in  equation  (7.25).  Employing  equation  (7.35), 

•1  r-  -»  iji 


and  defining  bX 
equation 


. = [ SR., 
J L J 


5V  . 
J 


this  condition  reduces  to  the 


A $R  + B(  bV  . + AV.)  = 0 


(7.36) 


This  equation  has  no  unique  solution  for  AV.  since  the  inverses  of 

*1.  *** 

A and  B do  not  exist.  Non-uniqueness  of  AV . is  to  be  expected  since 

A 

three  components  of  AV.  can  be  varied  to  satisfy  the  two  components 
of  T.  One  degree  of  freedom  remains  and  it  will  be  used  to  minimize 

^ ys.  rn  a* 

the  magnitude  of  AV.,  which  is  equivalent  to  minimizing  AV.  AV  . 

J J J 

Using  standard  constrained  minimization  techniques,  the  solution  for  A V 
is  given  by  J 

av  = r sx 

j 2VBP  i 


where 


r 

2VBP 


= [-bt(bbt)_1  A j -bt(bbt)"1  B 


(7.37) 
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This  concludes  the  derivation  of  the  guidance  matrices  for  the  three 
midcourse  guidance  policies  modeled  in  ERRAN  and  SIMUL. 

A quantity  which  is  particularly  useful  in  ERRAN  since  it  provides 
the  basis  for  the  computation  of  statistical  AV's  is  the  velocity 
correction  covariance  matrix  S ^ , defined  as  follows: 


S . = 

J 


(7.38) 


A useful  expression  for  S.  will  be  developed  below.  The  derivation 
follows  Reference  2.  J 

Substitution  of  equation  (7.24)  into  equation  (7.38)  yields 


But  according  to  equation  (7.2) 


5X~  = <5x7  + 5e. 

3 3 3 


(7.39) 


(7.40) 


Substituting  equation  (7.40)  into  equation  (7.39)  and  expanding  yields 


(7.41) 


Employing  the  definitions  given  by  equations  (7.1)  and  (7.3)  the  preceding 
equation  reduces  to 


S.  = /7  \ P “ + E [de7  <5X.“T]  + E [ SX~  5 e 7 T 1 + P “ 

3 3 \ cj  L J J J L j 1 J Kj  j 3 


(7.42) 


Pre-raultiplying  the  transpose  of  equation  (7.40)  by  , and  taking 

the  expected  value  of  the  result  yields 


[<$e~  5X^"  ]=  E [«e  “ 


T i 


5X. 

J 


Ki 


(7.43) 
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If  we  assume  that  the  estimate  6X.  and  the  error  in  the  estimate 

J 

5e . are  orthogonal,  as  is  the  case  if  the  recursive  estimation  algorithm 
is  optimal,  then 


E 


0 


so  that  equation  (7.43)  reduces  to 


E 


(7.44) 


(7.45) 


If  we  substitute  equation  (7.45)  into  equation  (7.42),  we  obtain  the 
desired  result: 


S 

j 


r. 

i 


(p 


- p 


J 


(7.46) 


It  was  stated  previously  that  ERRAN  treats  the  midcourse  guidance 
correction  in  an  ensemble  sense.  State  estimates  are  not  generated  in 
ERRAN,  so  that  equation  (7.24)  cannot  be  used  to  determine  AVj  * 

Instead,  we  compute  a statistical  or  effective  velocity  correction  in 
ERRAjJJ.  Simply  taking  the  expected  value  of  equation^ (7. 24)  does  not 
yield  useful  information.  The  expected  value  of  AVj  is  zero  since 

E is  zero,  which  is  a consequence  of  the  fact  that  our  recursive 

estimation  algorithm  is  an  unbiased  estimator.  However,  if  we  define 
the  effective  velocity  correction  to  be 


where 

p.  - E [|A?.|] 


(7.47) 


(7.48) 


and  aj  | of . | is  a unit  vector  aligned  with  the  most  likely  direction 
of  the  velocity  correction,  then  information  which  is  useful  for  fuel 
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sizing  studies  can  be  obtained.  This  effective  velocity  correction 
is  also  used  to  evaluate  the  execution  error  covariance  Qj  in  ERFAN. 

It  remains  to  define  expressions  for  magnitude  P.  and  direction 
d . Hoffman  and  Young  (reference  6 ) have  shown  that  a good  approx- 
imation for  Pj  is  given  by 


where 


P 

j 


1 

i 


I B (7T-  2)  | 

A \fTJl 


(7.49) 


A = trace  S . , 

J 

E-\X2+\X3+X2V 


and  X2.  X3 

given  by  equation 


are  the  eigenvalues  of  the  covariance  matrix 
(7.46). 


S 

J 


The  statistical  variance  of  the  magnitude  of  the  j-th  midcourse 
correction,  also  derived  in  approximate  form  in  reference  6 , is  given 
by  the  equation, 


a 


|Av . 

I J 


- trace  S - p ‘ 

j j 


(7.50) 


Velocity  correction  covariance  S . can  also  be  used  to  determine  the 

direction  C&  . Let  \ , A i and  A be  the  eigenvalues  of  S 
j A1  A2  3 j 

It  can  be  shown  that,  under  the  assumption  that  some  correction  takes 
place,  the  most  likely  direction  for  the  midcourse  maneuver,  defined 
probabilistically,  is  the  direction  of  the  eigenvector  associated  with 


the  maximum  eigenvalue  of  S.  . Define 

J 

associated  with  the  maximum  eigenvalue, 
assumes  ct  is  aligned  with  the  vector 

j 

of  this  latter  model  is  questionable. 


02  j as  this  eigenvector 

An  alternate  model  for  02 

T 


‘ -I  T 

LV  V M ‘ 


The  valid 


It  should  be  stressed  that  the  computation  of  the  effective  mid- 


course correction  vector 


"E  |A$  . j " 


within  ERRAN  is  only  an  artifice 


to  permit  a realistic,  a priori  computation  of  the  execution  error 
covariance  Q . The  nominal  trajectory  returned  to  the  basic  cycle 

j 

is  not  affected  by  the  computation.  However,  the  calculated  information 
concerning  likely  magnitudes  and  directions  for  the  maneuvers  is  critical 
for  fuel  sizing  studies. 

The  effective  velocity  correction  just  discussed  is  not  defined  in 
SIMUL  since  equation  (7.24)  can  be  used  directly  to  obtain  the  commanded 

velocity  correction  AV  . Also  computed  in  SIMUL  is  the  perfect 

J 

velocity  correction  given  by 

A V = r 5X~  (7.51) 

j j J 

and  the  error  in  the  correction  due  to  navigation  error  given  by 

AV  = _AV  - AV  (7.52) 

e . i i 


The  perfect  velocity  correction  A V represents  the  velocity  correction 

which  is  actually  required  to  null  out  target  errors  (assuming  linear 
guidance  theory)  since  SX~  is  the  actual  state  deviation  immediately 

prior  to  the  correction.  The  error  in  the  correction  due  to  navigation 
error  is  indeed  given  by  equation  (7.52)  since  substitution  of  equations 
(7.24)  and  (7.51)  into  equation  (7.52)  shows  that 


AV  = r.(  SX.  - SX.  ) - - r.  Se.  (7.53) 

® j .]  J J J J 

To  determine  the  efficacy  of  the  midcourse  correction  at  time  t 

j 

in  meeting  specified  target  conditions,  it  is  necessary  to  compute  the 
target  condition  covariance  matrix  Wj  , both  before  and  after  the 

correction.  Covariance  V.  is  defined  by 

J 

W = E [iT5TT]  (7.54) 

where  St  represents  the  actual  target  state  deviation.  Thus  W.  rep- 
resents the  statistical  dispersions  of  actual  target  state  deviations 
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about  the  nominal  target  state.  Substitution  of  equation  (7.25)  shows 
that 


V . P r)  . 

3 Cj  J 


r T1  T 

w = V E iX.  5 X . V . 

j J L j J -I  J 

Thus,  immediately  prior  to  the  midcourse  correction 

W " = V P 


J "j  3 


T 

V , 


(7.55) 


while  immediately  after  the  correction 


+ + T 

w = rj  p T) 


3 


3 


(7.56) 


Recall  that  control  covariance  P is  obtained  by  propagating  P 

c , c 

r t1 

over  the  time  interval  t.  , , t.  , where  t.  . is  the  time  of  the 

L J-l  jJ  J-l 

previous  guidance  event,  using  the  standard  covariance  prediction  equations 
in  section  5.2.  Recall  also  that  Pc  is  obtained  from  equation  (7.16). 

j 

In  SIMUL  we  also  compute  actual  target  errors  resulting  from  actual 
spacecraft  state  deviations  at  time  tj+  just  after  the  guidance  correction. 

Using  equation  (7.25),  we  obtain  the  total  actual  target  error 


tot . 
J 


f]  6 X 

j j 


(7.57) 


Combining  equations  (7.8)  and  (7.14),  we  obtain 


<o  + _ 

dX  = - Se.  + 

3 3 


SAV. 

J 


which,  when  substituted  into  equation  (7.57)  yields 


(7.58) 


tot . 
J 


V . Se  . + V . 

3 3 3 


<5  AV  . 

J 


(7.59) 
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Thus,  the  total  target  error  can  be  divided  into  the  target  error  due 
to  the  navigation  error 


6 


nav  . 
J 


be. 

J 


(7.60) 


and  the  target  error  due  to  the  execution  error 


6 

ex . 
J 


(7.61) 


It  will  be  helpful  to  summarize  all  the  quantities  computed  at  a 
midcourse  guidance  event  in  each  of  the  two  programs  ERRAN  and  SIMUL. 
A summary  is  presented  below: 


ERRAN 


SIMUL 


t : 
J 


t . : 
J 


— W - A - CO  mm 

X , X , bX  , b X , 
J j j j 


w . 

J 


r.,  A v . , { Av  , AV., 
J J J j 


-AV.,  AV  , Q 
I e.  J 


— + w + A+  ai  + 

X , X , 5 X , 5 X , 

j j j j 


■f  -f  4- 

pv  , p , y , € 

K . c . j nav . 

J J J 


£ , € 

ex.  tot. 

J J 
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7.4.2  Biased  Aimpoint  Guidance 

-f 

The  target  condition  covariance  W.  given  by  equation  (7.56) 

can  be  used  to  compute  the  probability  of  the  spacecraft  impacting  the 
target  planet.  If  planetary  quarantine  constraints  are  in  effect  and 
if  the  probability  of  impact  exceeds  the  allowable  probability  of  impact, 
then  the  nominal  aimpoint  must  be  biased  so  that  the  planetary  quarantine 
constraints  are  satisfied.  This  section  describes  the  biased  aimpoint 
guidance  technique  which  is  used  in  ERRAN  and  SIMUL  to  select  the  biased 
aimpoint.  The  technique  is  based  on  the  technique  presented  in  reference  13 0 

The  linear  impulsive  midcourse  guidance  policy  given  by  equation 
(7.24)  can  be  generalized  to  include  deviations  5/1,  from  the  nominal 
target  state:  J 


AV  = r 5X  + xlr  5/1  (7.62) 

' j j J j j 

The  derivation  of  the  guidance  matrix  is  very  similar  to  the 

derivation  F (section  7.4.1).  Only  the  details  of  the  derivation 

. j 

of  W . for  the  2VBP  policy  will  be  presented  here.  We  wish  to  select 

a AV , such  that  o"T  = 5 (1  in  equation  (7.2  5).  Employing  equation 

J A T 

(7.35)  and  defining  5 X . = | 5 R. , 5 V 1 , this  requirement  reduces  to 

the  equation  J L J j J 

(A  5R^  - SfJ  ^ + B(  5Vj  + AV  ) = 0 (7.63) 


This  equation  is  solved  in  the  same  manner  as  equation  (7.36)  was  solved. 
The  solution  is  given  by 

av.  = r ax  + bt(bbt)  1 a/i  (7.64) 

J J J j 


Thus,  for  2VBP  guidance, 

W = BT(BBV  (7.65) 

j 
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All  aimpoint  biasing  will  be  constrained  to  lie  in  the  impact 
plane.  Tnis  requirement  is  automatically  satisfied  for  the  2VBP  policy. 
The  other  two  policies,  however,  use  3-dimensional  target  states,  which 
means  we  simply  use  the  projection  of  the  aimpoint  in  the  impact  plane 
for  biased  aimpoint  guidance.  The  definition  of  the  FTA  impact  plane 
and  equations  for  the  ij/  matrix  for  each  policy  are  given  in. the 

j 

subroutine  BIAIM  analysis  section. 

In  computing  the  probability  of  impact  P0I,  we  first  project  the 
target  condition  covariance  matrix  VL  into  the  impact  plane  to  obtain 

the  covariance  matrix  _/[  . Then,  assuming  the  probability  density 

j 

function  associated  with  _/[  is  gaussian  and  nearly  constant  over  the 

j 

the  target  planet  capture  area  permits  us  to  compute  P0I  using 


P0I 


2 

7T  R p 
C 


(7.66) 


where  is  the  target  planet  capture  radius  and  p represents  the 

gaussian  density  function  evaluated  at  the  target  planet  center  and  is 
given  by 


(7.67) 


The  general  statement  of  the  biased  aimpoint  guidance  problem  is 
as  follows:  Find  an  aimpoint  n in  the  impact  plane  which  satisfies 

j 

the  impact  probability  (or  planetary  quarantine)cons traint 

P0I  - , (7.68) 

where  P^  is  the  allowable  probability  of  impact,  and  minimizes  a 
performance  functional  having  form 

* T w * T 

JM(A*.-/<)A(jl-0)«*ji  AS  fj  (7.69) 

J j j j 

(U 

where  A is  a constant  symmetric  matrix  that  will  be  defined  subsequently. 
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Using  equations  (7.66)  and  (7.67),  we  can  write  the  constraint 
equation  (7.68)  as 


T , -1  ^ 5 

M . A H . - C 

J J J 


(7.70) 


c = 2 


UlAf  prJ 

r qT  * r * *1T 

If  we  define  fJ.  = [t*  i>  I1  2\  ’ ^ L^l’^2 


(7.71) 


A = I a a I , and 
1 3 


a3  a2 


^3  ^2 


and  if  we  introduce  a slack  variable  q , then  equations  (7.69)  and  (7.70) 
can  be  written  as  follows: 


j = ax  (fii  - fii  r + 2a3(//i  - IU1  )(  H2  - U2  ) + 


* 2 

&2  ^ ^ 2 ” ^ 2 ^ 

2 2 2 2 
<P=k/j  +2  k fl  u + k LI  -c  - q = 0 
r 1 3 1 M2  2^2 


(7.72) 


(7.73) 


Solution  of  this  standard  constrained  minimization  problem  yields 
the  following  set  of  necessary  conditions: 


q = 0 


(7.74) 
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(*lS'"3V"l  + <a3X2  ' a2X3)"2  + <aiX2  ‘ a2Al)"l"2 


•K  *C  7C 

+ (-a  Xu  - a X /i  + a X U + a X U ) U + 

1 3^1  3 A 3 ” 2 3 ri  2 1^2  ^1 

^ ^ 

(-a1X2/i1  " a3^2fi2  + a3^3^1  + a2  ^ 3 ^2  ^ ^ 2 = 0 (7.75) 

The  method  used  to  obtain  //  and  //  from  equations  (7.73)  through 
(7.75)  is  described  in  the  subroutine  BIAIM  analysis  section. 

If  t is  the  time  of  the  final  midcourse  correction,  n . is 

j , * . J 

chosen  so  that  the  miss  distance  \ fl . ~ fl  | is  minimized.  Defining 
= I in  equation  (7.69)  will  provide  us  with  the  appropriate  fi  . If 

j 

t.  is  not  the  final  midcourse  correction,  U.  will  be  chosen  so  that 

1 j 

the  velocity  correction  required  to  remove  bias  i»y  at  the  time  t 

H J j+1 

of  the  next  midcourse  correction  is  minimized.  This  velocity  correction 
is  given  by 


AV 


j+i  * ‘ *j+i  J"j  • 


(7.76) 


A 

The  square  of  the  magnitude  of  AV , is  given  by 


j+1 


AV  AV 
j+1  j+1 


T T 

^4.1  6/J. 

J J+1  J + 1 J 


(7.77) 


Thus,  setting  = ^^+1  ^j+1  e9uatl°n  (7-69)  will  provide  us  with 

the  appropriate  H Once  bias  has  been  obtained,  the  bias  velocity 

correction  is  determined  from 


Av  = rj/  6/j 
j J J 


(7.78) 
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7.4.3  Nonlinear  Midcourse  Guidance 


Options  are  available  in  ERRAN  and  SIMUL  for  computing  velocity 
corrections  using  nonlinear  techniques.  In  ERRAN  we  use  the  targeted 
nominal  state  X~  as  the  zero-th  iterate  in  the  targeting  process, 

3 ~ _ ’X  - 

while  in  SIMUL  we  use  the  most  recent  state  estimate  . 

In  ERRAN  we  can  use  nonlinear  guidance  only  for  computing  the  bias 
component  of  the  velocity  correction.  The  statistical  component 

"E  J^AV.J  " can  only  be  computed  using  linear  theory.  This  restriction, 

of  course,  does  not  apply  in  SIMUL.  It  should  be  noted,  however,  that 
the  nonlinear  two-variable  B- plane  policy,  unlike  the  corresponding 
linear  policy,  constrains  the  z-component  of  A\^  to  be  zero. 

The  analytical  basis  for  nonlinear  targeting  is  presented  in 
section  4.4 

7.5  Other  Guidance  Event  Options 

7.5.1  Re- targeting 

In  ERRAN  and  SIMUL  a re- targeting  event  is  defined  to  be  the  com- 
putation of  a velocity  correction  A^1^  required  to  achieve  a new  set 

of  target  conditions  using  nonlinear  techniques.  As  with  nonlinear 
midcourse  guidance,  we  use  X.”  as  the  zero-th  iterate  in  ERRAN;  and 

- X - J 

X.  + oX.  , in  SIMUL.  Thus,  the  new  target  conditions  must  be  close 
J J 

enough  to  the  original  nominal  to  ensure  a convergent  targeting  process. 
The  analytical  basis  for  nonlinear  targeting  is  presented  in  section  4.4. 

7.5.2  Orbital  Insertion 


An  orbital  insertion  event  is  divided  into  a decision  event  and  an 
execution  event.  At  a decision  event  the  orbital  insertion  velocity 
correction  A^g,-,-  and  the  time  interval  At  separating  decision  and 

r _ ry 


execution  are  computed  based  on  X; 


in  ERRAN  and  on  X.  + SX 

J j 


in 


SIMUL.  At  an  orbital  insertion  execution  event,  A VrtT  is  executed  and 

(31 

the  new  cartesian  and  orbital  element  states  relative  to  the  target  planet 
are  computed.  The  analytical  basis  for  orbital  insertion  is  presented 
in  section  4.5. 


7.5.3  External  AV 

An  option  is  available  in  ERRAN  and  SIMUL  for  executing  an  externally- 
supplied  (input)  velocity  correction  A^LV.  In  ERRAN  AVt,„  is  added  to 

^ f\)  IjA  ili^Y 

X.  ; in  SIMUL,  to  X*  + SX  ~ . 

3 j J 


7,5.4  Impulse  Series  Thrust  Model 

All  the  analysis  presented  thus  far  in  Chapter  7 is  based  on  the 

assumption  of  an  impulsive  velocity  correction.  An  option  is  available 

in  ERRAN  and  SIMUL  for  modeling  the  impulsive  velocity  correction  as  a 

series  of  impulses.  This  section  discusses  the  method  of  computing  the 

effective  execution  error  covariance  Q ...  and  the  modified  update 

eft 

equations  whenever  an  impulse  series  thrust  model  is  used. 

The  modified  update  equations  will  be  discussed  first.  For  an 
impulsive  velocity  correction,  execution  errors  increase  only  the  velocity 
partition  of  the  knowledge  covariance.  However,  executing  a velocity 
correction  as  an  impulse  series  permits  execution  errors  to  influence 
the  entire  knowledge  covariance.  Thus,  the  knowledge  covariance  update 
equation  for  an  impulse  series  is  written  as 


<\> 
+ Q 


ef  f 


(7.79) 


We  continue  to  use  equation  (7.16)  to  update  the  control  covariance. 

In  ERRAN  the  targeted  nominal  state  is  updated  as  before.  However, 
in  SIMUL  we  compute  effective  estimated  and  actual  spacecraft  states  at 
tj.  These  states  approximate  the  effect  of  the  impulse  series  applied  . 
over  the  time  interval  AT,  where  AT  brackets  event  time  t ^ . The 

analytical  basis  for  the  computation  of  effective  states  is  presented  in 
section  4.6.  If  we  use  xeff  a^d  xeff  to  denote  the  estimated  and 

actual  spacecraft  states,  respectively,  then  the  state  and  deviation 
update  equations  employed  in  SIMUL  are  given  by 


ro  + 

A 

X 

x 

.1 

eff 

— + 

A 

X.  = 

X 

J 

eff 

A 

5 X . = 

X „„  - X „„ 

J 

eff  eff 

CO  i 

. A T 

d X . = 

J 

0 

(7.80) 


It  remains  to^describe  the  computation  of  the  effective 
error  covariance  Qeff  * We  assume  a series  of  n impulses 

i - 1,...,  n,  over  the  interval  AT  has  been  defined.  Let 
the  execution  error  covariance  associated  with  A V . Since 

l 


execution 
AV. , 


co 

Qi 

A 


denote 


is 
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Impulsive  we  can  use  the  impulsive  execution  error  model  described  in 

section  7.3  to  compute  Q . The  state  transition  matrix  over  the  interval 

i 

At.  separating  the  1-th  and  i+l-th  impulses  will  be  denoted  by  0(AtO. 

Then  the  effective  execution  error  covariance  after  the  second  impulse 
lias  been  applied  can  be  written  as 


(2) 

leff 


0 ( AtL) 


0 

0 


T 

d>  ( A t1)  + 


kl  J 


0 

0 


1 £ 

1 q2 


(7.81) 


Proceeding  recursively,  we  can  write  in  similar  fashion 


■§(i) 

eff 


*>(i-l)  x 

0 ( At  ) Q 0 (At.  ) + 

i-l  eff  l-l 


r i 

0,0 

” — i 

0 , Q . 


i-* 


(7.82) 


where 


«,(1) 

Qeff 


I fO 

L°  I V 


Then  the  effective  execution  error  covariance  matrix  for  the  entire 
interval  AT  is  given  by 


$»  ( n ) 

Qeff  = Qeff 


(7.83) 
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8.  GENERALIZED  COVARIANCE  ANALYSIS 


8.1  Introduction 

The  performance  of  navigation  filters  for  orbit  determination 
depends  on  how  well  the  physical  environment  and  ground-based  or 
onboard  measurement  instrumentation  can  be  modeled.  The  design 
of  a navigation  filter  involves  not  only  selection  of  an  algorithm 
for  processing  measurements,  but  also  specification  of  error  models 
for  all  error  sources  thought  to  be  important.  The  use  of  an  er- 
ror analysis  technique,  such  as  the  one  described  in  Chapter  5, 
is  not  sufficient  for  determining  actual  filter  performance  in  the 
presence  of  incorrectly  modeled  or  unmodeled  error  sources.  Al- 
though one  could,  of  course,  resort  to  a simulation  technique  such 
as  SIMUL  (Chapter  6)  to  study  filter  performance,  the  operation 
of  simulation  programs  is  expensive  and  only  a single  sample  of 
the  navigation  process  can  be  generated  on  each  run.  A generalized 
covariance  program,  however,  can  provide  much  useful  information 
relating  to  the  design  and  performance  of  navigation  filters,  with 
a significant  reduction  in  program  operating  costs. 

The  generalized  covariance  technique  described  in  this  chapter 
is  primarily  concerned  with  the  propagation  and  update  (at  a meas- 
urement) of  both  actual  and  assumed,  i.e.,  filter-generated,  es- 
timation error  statistics  along  a nominal  trajectory.  The  deviation 
of  the  generalized  covariance  equations  assumes  linearity  and 
gaussian  statistics.  Actual  error  statistics,  however,  are  not 
required  to  have  zero  means.  The  equations  are  written  in  recur- 
sive form  and  are  filter-independent,  i.e.,  filter  gains  are  not 
assumed  to  have  been  generated  by  any  specific  type  of  navigation 
filter. 

The  generalized  covariance  equations  for  the  basic  cycle 
(measurement  processing)  are  derived  in  section  8.2.  These  equa- 
tions can  be  used  to  determine  filter  sensitivity  to  differences 
between  assumed  (by  filter)  and  actual: 

1)  Injection  statistics; 

2)  Measurement  noise  statistics  — doppler,  range,  optical 
measurements ; 

3)  Dynamic  parameter  statistics  — gravitational  constants, 
target  planet  ephemerides ; 

4)  Measurement  parameter  statistics  — instrument  biases, 
station  location  errors; 

5)  Dynamic  noise  statistics. 
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The  differences  between  assumed  and  actual  error  statistics  can 
involve  differences  in  means,  standard  deviations,  and  correlation 
coefficients.  Actual  error  statistics  can  also  be  defined  for 
parameters  whose  uncertainty  has  been  ignored  in  filter  design. 

In  section  8.3  the  generalized  covariance  technique  is  ex- 
tended to  the  guidance  process.  The  equations  presented  there 
permit  one  to  determine  the  sensitivity  of  the  guidance  process 
to  differences  between  assumed  and  actual  execution  error  statis- 
tics, as  well  as  to  differences  in  the  previously  described  er- 
ror statistics.  Although  execution  errors  are  assumed  to  be  un- 
correiated,  they  are  permitted  to  have  nonzero  means.  The  gen- 
eralized covariance  technique,  as  applied  to  the  guidance  process, 
primarily  involves  the  computation  of  both  assumed  and  actual 
target  dispersions  and  velocity  correction  statistics. 

The  notation  employed  in  this  chapter  is  very  similar  to  the 
notation  used  in  previous  chapters,  except  for  the  following  dif- 
ferences : 

1)  Estimation  errors  are  denoted  by  x,  etc  instead  of 
by  6e,  etc; 

2)  Actual  errors,  deviations,  means,  covariances,  etc 
are  usually  denoted  by  ( ) ' . 

8.2  Generalized  Covariance  Propagation  and  Update 


8.2.1  The  Basic  Cycle 


The  generalized  covariance  basic  cycle  consists  of  the  propa- 
gation of  both  actual  and  assumed  estimation  error  means  and  co- 
variances  from  the  previous  measurement  time  (or  event)  to  the 
present  measurement  time,  and  the  updating  of  each  of  these  quan- 
tities after  the  measurement  has  been  processed.  The  propagation 
and  update  of  the  assumed  covariances  was  treated  in  Chapter  5 
(assumed  estimation  error  means  are  zero) . The  equations  required 
to  propagate  and  update  the  actual  estimation  error  means  and 
covariances  are  derived  in  this  section.  These  equations  are 
filter-independent  and  are  expressed  in  terms  of  arbitrary  filter 
gain  matrices. 

A 

The  filter  employs  an  augmented  state  vector  x partitioned  as 

rx 


(8.1) 
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where  x denotes  assumed  position/velocity  deviations  (from  nominal) ; 
xg,  assumed  solve-for  parameter  deviations;  u,  assumed  dynamic 

consider  parameter  deviations;  and  v,  assumed  measurement  consider 
parameter  deviations.  The  assumed  dynamics  are  described  by 


*k+i  ’ 


3 x + 8 ' u,  + w.  , , 

XX  s,  XU  K.  K+l 

s k 


where  state  transition  matrix  partitions  $.0  , and  0 are 

xx  xu 

s 

defined  over  the  time  interval  [t^,  t^+^] , and  denotes  the 

contribution  of  assumed  unmodeled  accelerations  over  the  same  time 
interval.  Parameter  deviations  are  constant.  The  assumed  meas- 
urement is  given  by 


yk+i ' Hxk+i + Mxs.J.1  + G\+i + Lvk+i  + Vi  (8-3) 

k+l 

where  H,  M,  G,  and  L are  observation  matrix  partitions  evaluated 

at  time  t,  , , , and  v.  , , denotes  the  assumed  measurement  noise, 
k+l  k+l 

The  actual  augmented  state  vector  x'^  is  partitioned  as 


(8.4) 


where  x'  denotes  actual  position/velocity  deviations;  x',  actual 

s 

solve-for  parameter  deviations;  u',  actual  dynamic  consider  param- 
eter deviations;  v' , actual  measurement  consider  parameter  devia- 
tions; and  w',  actual  dynamic  and  measurement  ignore  parameter 

deviations.  The  parameters  x',  u1 , and  v'  correspond  to  x , u, 

s s 

and  v,  respectively,  but  have  different  statistical  representations. 
Ignore  parameters  w'  are  parameters  whose  statistical  uncertainty 
is  completely  ignored  by  the  filter,  but  not  by  the  actual  esti- 
mation error  mean  and  covariance  propagation  process.  (Parameters 
not  treated  by  either  the  filter  or  the  actual  propagation  process 
will  be  referred  to  as  neglect  parameters.)  The  actual  dynamics 
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are  described  by 


x.'  , = 4x.'  + e x'  + 0 u.'  + 0 w,'  + w'  (8.5) 

k+1  k xx  s,  xu  k xw  k k+1 
s k 

where  <jj'  , . denotes  the  contribution  of  actual  unmodeled  accele- 
k+1 

rations  over  the  time  interval  [t^»  t^+^] . State  transition  ma- 
trix partition  0^  relates  changes  in  ignore  parameters  to  changes 

in  x' . All  parameter  deviations  are  constant.  The  actual  meas- 
urement is  given  by 

K+i  ‘ H*hi + + K+i + K+i + B"k+i + vk+i  (8-6) 

k+1 

where  v ' , , denotes  the  actual  measurement  noise  at  t 

k+1  k+1 

The  actual  estimation  errors  are  defined  by 


*k+l = 

\+l  *k+l 

(8.7) 

x'  : 

Sk+1 

/V  f 

= X - X 

Sk+1  Sk+1 

(8.8) 

^+1  = 

\+l  ” “k+1  = -uo 

(8.9) 

*k+l  = 

V - V * = —V ' 

k+1  k+1  o 

(8.10) 

^k+1  = 

ft,  , , - w'  = -w' 

k+1  k+1  o 

(8.11) 

where  equations  (8.9),  (8.10),  and  (8.11)  have  used  the  fact  that 
estimates  u,  v,  and  w are  always  zero. 

The  estimates  propagate  over  the  time  interval  [t  , t ] 
according  to  k k+1 


Vl  ■ + e«  xs 


+ 

s k 


(8.12) 
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and 


.+ 


= x 


k+1 


(8.13) 


where  ( ) denotes  values  immediately  before  processing  a meas- 
urement and  ( )+  immediately  after.  Substitution  of  equations 
(8.5)  and  (8.12)  into  equation  (8.7)  yields  the  following  equation 
for  the  propagation  of  the  actual  estimation  error: 


1 = + 9 x+l  - 6 u'-9  w'-lo' 


\+l  = $Xk 
Similarly, 


xx  s,  xu  o xw  o 
s k 


x • = x+' 


k+1 


(8.14) 


Sk+1  sk 


(8.15) 


At  measurement  time  t^+^  the  estimates  are  updated  using 
the  equations 


*k+l  \+l  + ^+1  ek+l 


x = x + S, 
Sk+1  Sk+1  1 


k+1 

(8.16) 

ek+l 

(8.17) 

where  and  are  the  filter  gain  matrices  (generated  by  an 

arbitrary  filter).  The  actual  measurement  residual  e ' is  defined 
as  the  difference  between  the  actual  and  predicted  measurements 


£k+l  = yk+l  " H\+l  - ^s 


k+1 


(8.18) 


Substitution  of  equation  (8.6)  into  equation  (8.18)  yields 


k+1 


= - H: 


\+l 


- Mx  ' 
Sk+1 


Gu* 

o 


+ Lv' 
o 


Nw' 

o 


+ v. 


k+1 


(8.19) 


The  update  equation  for  the  actual  estimation  error  is  obtained 
by  substituting  equation  (8.16)  into  equation  (8.7).  The  resulting 
equation  is 


\il 


*k+l  + \+l  Ek+1 


(8.20) 
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Similarly, 


x 


+ t 


= x 


+ S. 


k+1 


k+1 


k+1  L k+1 


(8.21) 


The  propagation  and  update  equations  for  the  means  of  the 
actual  estimation  errors  and  the  actual  measurement  residuals  can 
now  be  derived.  The  filter  assumes  zero  means  for  all  estimates 
and  all  error  sources.  Except  for  actual  dynamic  and  measurement 
noises,  this  is  not  the  case  for  the  actual  propagation  and  up- 
date process.  Thus, 


= -u 


= -v 


Etak+d 


= -w ' 


EK«]  ' 0 


EK+i] 


- 0 


(8.22) 


No  generality  is  lost  by  setting  the  mean  of  the  actual  measurement 
noise  v*  to  zero,  since  a nonzero  measurement  mean  can  be  absorbed 
into  the  mean  of  the  actual  measurement  bias.  The  model  for  the 
actual  dynamic  noise  u'  will  be  assumed  to  have  the  same  form  as 
the  model  for  the  assumed  dynamic  noise  described  in  section  5.3  so 
the  mean  of  oj'  is  also  set  to  zero. 


Applying  the  expectation  operator  to  equations  (8.14)  and  (8.15) 
yields  the  following  equations  for  the  propagation  of  the  means 
of  the  actual  estimation  errors: 


E[*kh!  ■ 


E[<'] 


+ 0 


XX 


E[<f] 

k 


0 u'  - e w'  (8.23) 

XU  o xw  o 


m s'  ] 
k+1 


E[xt’] 


(8.24) 
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To  initiate  the  propagation  process  described  by  the  previous  two 

equations  requires  initial  values  for  the  means  of  x'  and  x'.  At 

initial  time  t we  have 
o 

E[x']  - E[x  ] - E[x']  (8.25) 

o o o 

and 

E[x'  ] = E[x  ] - E [x'  ] (8.26) 

s s s 

o o o 

Because  initial  estimates  are  always  assumed  to  be  zero,  equations 
(8.25)  and  (8.26)  become 


E[x']  = -x’ 
oJ  o 


(8.27) 


E [x ' ] = -x'  (8.28) 

s s 

o o 

where  x*  and  x'  are  the  initial  means  of  the  actual  position/ 
os 

o 

velocity  and  solve-for  parameter  deviations,  respectively. 

Applying  the  expectation  operator  to  equation  (8.19)  yields 
the  following  equation  for  the  mean  of  the  actual  measurement 
residual: 

E[e.'  , . ] = - H • E [xT ' ] - M • E[x_'  ] + Gu'  + Lv'  + Nw'  . (8.29) 

k+1  K+l  s,  . . o o o 

k+1 


The  update  equations  for  the  means  of  the  actual  estimation 
errors  are  obtained  by  applying  the  expectation  operator  to 
equations  (8.20)  and  (8.21).  The  resulting  equations  are: 


E[<ll]  = E[\il]  + 

E[x+'  ] = E[x“’  ] 

sk+l  sk+l 


^i+l  ' E[Ek+l' 

(8.30) 

+ Sk+1  • E[ek+11  • 

(8.31) 
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The  remainder  of  this  section  will  treat  the  derivation  of 
the  propagation  and  update  equations  for  the  actual  knowledge 
covariance  matrix  partitions.  Since  the  actual  estimation  errors 
do  not,  in  general,  have  zero  means,  it  becomes  more  convenient, 
.from  both  an  analytical  and  a computational  standpoint,  to  develop 
propagation  and  update  equations  for  the  2nd  moment  matrices  rather 
than  for  the  covariance  matrices,  and  then  simply  convert  the  2nd 
moment  matrices  to  covariance  matrices  using  the  standard  relation- 
ship 


cov  (x,y)  = E[xyT]  - x y1  (8.32) 

T 

where  cov  (x,y)  denotes  the  covariance  of  x and  y,  and  E[xy  ] 
denotes  the  2nd  moment  matrix  of  x and  y. 


The  required  actual  2nd  moment  matrix  partitions  are  defined 
in  the  following  pages.  Note  that  primes  have  been  dropped  from 
the  2nd  moment  variables  to  make  the  equations  more  readable  in 


the  remainder  of  this  section, 
that  must  be  updated  whenever  a 
first. 


p 

= E[X’ 

x,T] 

c 

XX 

s 

= E[x’ 

C 

XU 

= E[i' 

0'T] 

C 

XV 

= E[x' 

V,T] 

C 

VT.7 

'X 

Cd 

II 

w’T] 

The  2nd  moment  matrix  partitions 
measurement  is  processed  are  listed 


p 

s 

= E[x' 
s 

x,T] 

s 

c 

X u 
s 

= E[x' 
s 

u,T] 

C 

X V 

s 

= E[i* 
s 

v'T] 

(8.33) 

C 

X w 

= E[x' 
s 

w,T]  . 

s 


The  remaining  2nd  moment  matrix  partitions  do  not  change  with  time: 


E[u' 

v'T] 

= C 

uv 

o 

>2 

W 

II 

1=) 

u,T] 

o 

D 

II 

E[u* 

w'T] 

= C 

uw 

o 

V = E[v' 

v'T] 

= V 

n 

(8.34) 

u 

E[v* 

w'T] 

= C 

vw 

W = E[w’ 

W,T] 

= w . 

o 

o 
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The  2nd  moment  matrix  propagation  equations  for  the  time  in- 
terval [t,  , t,  ] are  obtained  by  substituting  equations  (8.14) 

K K i 

and  (8.15)  into  (8.33)  and  expanding.  All  equations  are  simplified 
by  assuming  w ' and  (x/,  x'  , 07 , v ' , w')  are  uncorrelated.  Thus, 

f 1 K tC  S.  K K K. 

for  example,  k 

E[x^  aj^T]  = E [x^]  • E[a^T]  = 0 

since  the  mean  of  has  been  assumed  to  be  zero.  The  final 
propagation  equations  are  summarized  below: 


i +T  + t +T  \ T 

P,  = ! *P,  + 9 C +0  C + 0 C W 
k+1  \ k xx  xx  ^ xu  xu^  xw 

k 


+ C 


XX 


’k+1 


6 + C 

i 

s 


T 

e + c 


XX  _ XUk+l  xu  xw- 


k+1 


9xw  + Qk+1 


XX 


k+1 


+ + +T  +T 

$c  +e  p +e  c +e  c 

XX  XX  S,  XU  X U XW  X w 

s,  s k s , s , 

k k k 


’"k+l 


<I>C+  +0  C+  +9  U+0  CT 

XU,  XX  X U XU  O XW  UW 

K S S , C 


XV, 


k+1 


<I>C+  +0  C+  + 0 C +ecT 

XV,  XX  X V xu  uv  xw  vw 

k s s , o o 

k 


xw. 


k+1 


<J>C+  +0  C+  +0C  +6  W 

XW,  XX  X W XU  UW  xw  o 

k s s , o 

k 


P = P 
Sk+1  Sk 


C = C 

X u X u 

s k+1  s k 


(8.35) 

(8.36) 

(8.37) 

(8.38) 

(8.39) 

(8.40) 

(8.41) 
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(8.42) 


C = C+ 

XV  XV 

S k+1  s k 


C = C 

X w X w 

s k+1  s k 


(8.43) 


The  actual  dynamic  noise  2nd  moment  matrix  Q will  be  assumed 
to  have  form 

Qk+1  = diag  (k  At4,  % At4,  % At4,  Kj  At2,  At2,  At2) 

where  At  = tk+^  - t^,  and  K^,  , and  are  constants  which  roughly 

correspond  to  the  variances  of  the  actual  unmodeled  accelerations . 
The  form  of  this  equation  is  identical  to  that  of  equation  (5.23). 

The  actual  measurement  residual  2nd  moment  matrix  is  defined 
by 


Jk+1  " E[ek+1  £k+l  ] • (8.45) 

Substituting  equation  (8.19)  into  equation  (8.45)  yields 

Jk+i ' HAk+i + “k+i + 'Vi + L\+i + 8Fk+i  + Vi  (8-46> 

where  observation  matrix  partitions  H,  M,  G,  L,  and  N have  been 
defined  previously,  R is  the  actual  measurement  noise  2nd  moment 
matrix  defined  by 


\+l  E[vk+1  Vk+1  ] 


(8.47) 


and 


\+l  Pk+1  H + C 


xx 


T 

M + C 


Xi 


’k+1 


\+l 


T 

G + C 


xv. 


T 

L + C 


k+1 


xw. 


N 


k+1 


-T-T  T - T - T - 1 

B,  = P M + C H + C G + C L + C N 

k+1  s.  , , xx  xu  xv  xw 

k+1  Sk+1  S k+1  S k+1  S k+1 


(8.44) 


(8.48) 

(8.49) 
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rp  rp  rp  rp  rp  rp  rp 

D,  , = C H + C M + U G + C~  N + c”  L (8.50) 

k+1  xu.  , i xu  o uw  uv 

K+1  S , , . O O 


rp  rp  rp  rp  rp  rp  rp  rp 

E.  _ = C_i  H + C M + C N + V L + C G 

k+1  xv,  . xv  vw  o uv 

k+1  s . . , o o 

k+1 


(8.51) 


rp  rp  rp  rp  rp  fp  rp  rp  rp 

F.  , = W N + C H + C M + C L + C G . (8.52) 

k+1  O XW.  , , X V7  vw  uw 

k+1  s , . , o o 

k+1 

The  2nd  moment  matrix  update  equations,  which  correspond  to 
the  processing  of  a measurement,  are  obtained  by  substituting  equa- 
tions (8.20)  and  (8.21)  into  (8.33)  and  expanding.  The  final  up- 
date equations  are  summarized  as 


P+  = P 
k+1  k+1 


.T  ,„T 


*1*1  A ' ^k+l  + \+l  Jk+1  \+l  (8*53) 


Sk+1  Sk+1 


:xx  -Vl8  - ^k+l  + \+l  Jk+1  Sk+1  (8'54) 


k+1  k+1 


c+ 

xuk+l 

T 

= C - K.  , . D 

XUk+l  ^+1 

(8.55) 

c+ 

xvk+l 

T 

= C - K.  , . E 

XVk+l  30+1 

(8.56) 

C+ 

^k+l 

T 

= C - K.  F 

xw.  , , k+1 

k+1 

(8.57) 

" Sk+1 

T T T 

B - BSk+l  + Sk+1  Jk+1  Sk+1 

(8.58) 

C+ 
x u 

= c"  - s dt 

x u k+1 

(8.59) 

s k+1  S k+1 


+ - T 

C = C - S.  , . E1 

xv  xv  k+1 

S k+1  S k+1 


(8.60) 


+ - T 
C = C - S,  , . F1 
x w x w k+1 

S k+1  S k+1 


(8.61) 


where  and  S 


are  the  filter  gain  constants. 
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8.2.2  Eigenvector  and  Prediction  Events 

The  generalized  covariance  treatment  of  eigenvector  and  pre- 
diction events  is  quite  similar  to  their  treatment  in  an  error 
analysis.  At  an  eigenvector  event,  eigenvalues,  eigenvectors,  and 
hyperellipsoids  are  computed  for  both  assumed  and  actual  knowledge 
covariances.  At  a prediction  event,  both  assumed  and  actual  know- 
ledge covariances  are  propagated  forward  to  t^,  the  time  to  which 

the  prediction  is  to  be  made.  If  t occurs  within  the  target  planet 

sphere  of  influence,  both  assumed  and  actual  covariances  are  con- 
verted from  cartesian  coordinates  to  B-plane  coordinates  (see 
section  5.6  for  more  details). 


8.3  Generalized  Midcourse  Guidance  Analysis 


8.3.1  Target  Condition  Dispersion  Analysis 


To  generate  actual  target  condition  dispersions  (mean  plus 
covariance)  requires  that  equations  be  developed,  first,  for  prop- 
agating actual  deviation  means  (control  means)  and  actual  control 
2nd  moment  matrix  partitions  over  the  time  interval  [t^_^,  t_.  ] 

separating  two  successive  guidance  events.  Second,  equations  must 
be  developed  for  updating  actual  knowledge  and  control  means  and 
2nd  moment  matrices  following  the  execution  of  a guidance  event. 
These  equations  are  derived  in  this  section. 


The  actual  dynamics  over  the  time  interval 
described  by 


tj]  are 


- Gx!,  + 0 

j-1  XXr 


0 u'  + 

XU  o 


e w'  + 

xw  o 


(8.62) 


where  actual  parameter  deviations  x’,  u' , v',  and  w'  do  not  change 

+ s 

with  time.  Notation  ( ) and  ( ) indicates  values  immediately  be- 
fore and  after  a guidance  correction,  respectively.  Applying  the 
expectation  operator  to  equation  (8.62)  yields  the  following  mean 
propagation  equation: 


$x'+9  x'  +0  u'+0  w’ 

i-l  xx  s xu  o xw  o 
J so 


(8.63) 


where  we  have  assumed  that  the  mean  of  actual  unmodeled  accelera- 
tion Wj  is  zero. 
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The  dispersions  of  the  actual  deviations  about  the  targeted 
nominal  trajectory  are  represented  by  the  control  2nd  moment  matrix 


P' 


c 


3 


(8.64) 


and  related  partitions.  Equations  (8.35)  through  (8.43)  can  be 

used  to  propagate  all  control  2nd  moment  matrix  partitions  over 

the  interval  [t.  t.]  if  we  treat  all  2nd  moment  variables  ap- 

J-l  J 

pearing  in  these  equations  as  control  2nd  moment  variables. 


Initial  control  2nd  moment  matrix  partitions  are  identical  to 
initial  knowledge  2nd  moment  matrix  partitions  since  all  initial 
estimates  are  zero. 


The  updating  of  actual  knowledge  and  control  means  and  2nd 
moment  matrices  following  the  execution  of  a guidance  event  re- 
flects the  introduction  of  actual  execution  error  statistics  into 
the  mean  and  2nd  moment  matrix  propagation  processes.  The  actual 
estimation  error  at  a guidance  event  is  increased  by  the  actual 
execution  error 


<5AV'.  = AV!  - av! 
J J J 


(8.65) 


where  AV!  is  the  actual  velocity  correction  and  AV!  is  the  actual 
3 3 


commanded  velocity  correction.  Therefore,  the  estimation  error  im- 
mediately following  the  velocity  correction  is  given  by 


x!+  = x|  - A • <5AV ! (8.66) 

3 3 3 

where 

A = [0  : I]T  . / 

The  actual  knowledge  2nd  moment  matrix  immediately  following 
the  correction  is  defined  by 

P^+  - E [x’+  x!+T]  . (8.67) 
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Substitution  of  equation  (8.66)  into  equation  (8.67)  yields 


P,+  = P'  + A • E [ 6 A V ! SAV'T  • AT  - A • e[saV'.  x!“r| 

L J J J LjjJ 

- E 6AVjT]  ‘ aT  • (8.68) 

Defining  the  actual  execution  error  2nd  moment  matrix  by 

= EpAVj  6AVjT1  (8.69) 


and  assuming  the  estimation  error  immediately  prior  to  the  cor- 
rection and  the  execution  error  to  be  uncorrelated  permits  us  to 
rewrite  equation  (8.68)  as 


P'+  = P’“  + AQ'  AT  - A • E [d AV! 1 • 
Kj  Kj  J L 


(8.70) 


The  mean  of  the  actual  estimation  error  immediately  following 
the  correction  is  obtained  simply  by  applying  the  expectation 
operator  to  equation  (8.66)  to  obtain 


E xj+J  = J - A • E 6AVjj  . (8.71) 


The  propagation  equation  for  E 


An  expression  for  E 


H] 


x'  . 
J. 


is  given  by  equation  (8.23) . 


is  given  in  section  8.3.3. 


The  actual  estimation  error  following  the  correction  is  de- 
fined by 


(8.72) 


But,  since  we  assume  that  the  nominal  state  is  updated  with  the  most 
recent  estimate  at  a guidance  event, 

xj+  = 0 . (8.73) 
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Then,  substituting  equations  (8.72)  and  (8.73)  into  equation  (8.66) 
yields 

x!+  = - x!"  + A • 6AV ! . (8.74) 

2 3 3 

The  actual  control  2nd  moment  matrix  following  the  correction 
is  defined  by 

P^+  = E [x.!+  x^+TJ  • (8.75) 

Substitution  of  equation  (8.74)  into  equation  (8.75)  and  comparing 
the  result  with  equation  (8.68)  shows  that 


Pc+  = PK+  • (8*76) 

J J 


Taking  the  expected  value  of  equation  (8.74)  and  comparing 
the  results  with  equation  (8.71)  shows  that 


(8.77) 


Similarly,  under  the  assumption  that  we  update  the  nominal  solve- 
for  state,  we  can  write 


(8.78) 


The  remaining  control  2nd  moment  matrix  partitions  are  updated 
in  the  same  manner  as  the  position/velocity  partition  is  updated 
in  equation  (8.76). 


Equations  for  the  actual  target  dispersions  can  now  be  de- 
veloped. The  actual  target  state  deviation  St!  is  related  to  the 

actual  state  deviation  xj  at  time  t_.  according  to 


St!  = n . x ! 
3 3 3 


(8.79) 


where  n . is  the  variation  matrix  (see  section  7.4.1)  for  the  ap- 
propriate midcourse  guidance  policy.  The  mean  of  St!  is  given  by 


104-15 


E [St j ]'  = n j E [xj] 


(8.80) 


The  statistical  target  dispersions  are  represented  by  the  actual 
target  condition  2nd  moment  matrix  Wj  , which  is  defined  as 


W!  = E ["st  ! 6 t T 1 . 

2 L 2 2 


(8.81) 


Substitution  of  equation  (8.79)  into  equation  (8.81)  yields 

W'  = n.  P'  n.T  • 

J J Ci  J 


(8.82) 


Equations  (8.80)  and  (8.82)  are  evaluated  immediately  before 
and  after  the  guidance  correction  at  time  t^ . 

8.3.2  Velocity  Correction  Analysis 

The  actual  commanded  velocity  correction  2nd  moment  matrix 
is  defined  by 

= e|aV^  AV^TJ  (8.83) 

where  the  actual  commanded  velocity  correction  is  given  by 


av'.  = r . x!  = r . (x!  + x!) 
2 2 2 2 2 2 


(8.84) 


The  guidance  matrix  T corresponds  to  the  appropriate  linear  mid- 
course guidance  policy  (see  section  7.4.1). 

Substitution  of  equation  (8.84)  into  equation  (8.83)  yields 

Sj  = rj  {E[xj  xjT]  + E[xj  xjT]  + E[xj  xjT]  + E[xj  xjT]}  rj  '(8,85) 

We  can  write 

Eb  *jT]  ■ *f]  - E[*i  *?]  • (s-86> 

Then,  substituting  equation  (8.86)  into  equation  (8.85),  we  obtain 

s5 ' rj{E[xi  *jT]  - E[*i  *iT] + E[*j  *jT] + E[*]  ■ <8-87) 
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I ^ 


If  we  define 


% ‘ *jT] 


(8.88) 


and  use  the  definitions  of  control  and  knowledge  2nd  moment  matrices, 
we  can  write  equation  (8.87)  as 


s!  = r 

3 3 


i(?'c.  -PK.  +CE.  +CETK  ' 
\ 3 3 3 3/ 


(8.89) 


The  corresponding  expression  for  the  assumed  velocity  cor- 
rection covariance  (section  7.4.1)  is  given  by 


s.  = r 

3 3 


> (s  - \)  ’• 


(8.90) 


The  assumed  covariance  C does  not  appear  in  equation  (8.90)  since 

E . 

3 

the  navigation  filter  assumed  the  estimate  and  the  estimation  er- 
ror to  be  orthogonal  (if  the  filter  employs  an  optimal  estimation 
algorithm) . 

The  proper  evaluation  of  equation  (8.89)  for  Sj  requires  that 

C'  and  associated  partitions  be  propagated  between  measurements 
E . 

3 

and  updated  at  each  measurement.  A set  of  propagation  and  update 

equations  for  C'  and  associated  partitions  can  be  developed  in  a 
E . 

3 

straightforward  fashion.  These  is  some  question,  however,  about 
the  feasibility  of  carrying  along  an  additional  set  of  2nd  moment 
partitions  merely  to  obtain  a better  value  for  Sj.  The  programmed 

generalized  covariance  guidance  model  will  assume  C^,  can  be 
neglected  in  equation  (8.89).  j 

The  mean  of  the  actual  commanded  velocity  correction  is  ob- 
tained by  applying  the  expectation  operator  to  equation  (8.84): 


e[av'.]  - r.  {e[,]  + e[*:]} 


(8.91) 


Expressions  for  E[x^]  and  are  already  available. 
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Equation  (8.91)  gives  no  useful  information  for  fuel  sizing 
studies.  Instead,  we  must  develop  an  expression  for  E[|AV^|].  In 

section  7.4.1  the  Hoffman-Young  formula  is  used  to  evaluate  the 
assumed  E^AV^IJ.  We  shall  use  the  same  formula  to  evaluate 

E[lAVjll-  Thus 


S[l^|]  - V?  ( 


1 + 


B (tt-2) 
A2  /I74 


(8.92) 


where  now 

A = trace  S ! 

3 

B = xi  A2  + xi  A3  + X2  x3  • 

and  \'v  A),,  and  A^  are  the  eigenvalues  of  the  2nd  moment  matrix 

Sj.  No  rigorous  justification  for  the  use  of  rather  than 

cov  (AVp  to  evaluate  E [|aV^|]  is  available  at  present.  It 

should  be  apparent,  however,  that  the  use  of  cov  (AVj)  would  not 

reflect  the  fact  that  the  actual  commanded  velocity  statistics 
are  distributed  symmetrically,  not  about  the  origin,  but  about 
E[AV!  ] . 

The  actual  effective  or  statistical  AV  is  defined  as 


"E[AV!]"  = e|Jav!|] 


(8.93) 


where  denotes  a unit  vector  in  the  most  likely  direction  of 

the  velocity  correction.  Although  two  options  are  presently 
available  in  ERRAN  for  computing  the  most  likely  direction  of 
the  assumed  statistical  AV,  only  one  of  these  options  will  be  de- 
fined for  the  generalized  covariance  guidance  model.  The  first 

T 

option  assumes  is  aligned  with  Lsli*  S22 * s33j  • where  the 

S_j^  are  the  diagonal  elements  of  . Because  this  method  presents 

difficulties  in  the  evaluation  of  E [6AVl]  and  Q'.,  it  will  not 

3 3 
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be  used.  The  2nd  option,  which  will  be  used  in  the  generalized 
covariance  guidance  model,  assumes  a!  is  aligned  with  the  eigen- 
vector associated  with  the  maximum  eigenvalue  of  . 

8.3.3  Execution  Error  Model 


The  actual  execution  error  6AV!  will  be  assumed  to  have  form 

3 

av! 

5AV!  = k’AV'.  + s'  L + 6AV'  . . (8.94) 

3 3 |AV.|  pointing 

3 

where  k'  denotes  the  actual  proportionality  error;  s',  the  actual 

resolution  error;  and  6AV'  . . the  actual  pointing  error. 

pointing  r & 

These  actual  execution  errors  are  not  required  to  have  zero-mean 
statistics . 


Both  the  mean  and  2nd  moment  of  6AV|  are  difficult  to  eval- 

3 

uate  because  of  the  complicated  functional  dependence  of  6AV^  on 
AV^ . This  problem  is  also  encountered  in  the  generation  of  as- 
sumed execution  error  statistics,  and  will  be  resolved  by  making 
certain  simplifying  assumptions. 


The  components  of  SAV 
are  reproduced  as 


6AV'  = ( k' 

x V 


+ 


6AV'  = 1 

fk' 

+ ^- 

D> 

<> 

+ 

1 1 

y 

\ 

P / 

y 

6AV'  = i 

(k* 

A _ 

AV'  - y 

z 

\ 

p / 

z 

AV'| , y 

1 _ 

[AV'2 

X 

+ AV'2] 

y 

can  be  found  in  equation  (7.21)  and 


+ 


p 'AV'  6a'  + AV'  AV'  5g ' 
y x z 


x 


(8.95) 


(8.96) 


(8.97) 


k 


actual  pointing  angle  errors. 

Before  operating  on  equations  (8.95),  (8.96),  and  (8.97)  to 

obtain  expressions  for  E [6AV'.l  and  Q'.  = E 15 A V ! dAV'.^l,  we  shall 

A /.  3 3 L 3 3 _J 

assume  that  AV' , AV',  and  AV'  can  be  replaced  by  the  components 
x y z 
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of  the  actual  statistical  velocity  correction  "EfAV^]".  This 

means  only  k',  s',  6ot',  and  6g'  need  be  treated  as  random  variables 
when  we  apply  the  expectation  operator  to  these  equations  or  to 
any  products  of  these  equations. 

Under  the  previous  assumption,  we  obtain  the  following  ex- 
pression for  the  mean  of  6AV'. : 


E[6AV'.]  = E[5AV']  e + E[6AV']  e + E[6AV']  e 
j xx  y y z z 


(8.98) 


where 


E[6AV' ] 
x 

E [ 6 A V^ ] 

E [ 6 A V ' ] 
z 


p'AV'  6a’  + AV'  AV'  66' 

y x z 

m' 

AV’  AV'  Iff'  - p'AV'  6a' 

y z x 

v' 

u’  68' 


(8.99) 

(8.100) 
(8.101) 


and  e , e , and  e denote  three  unit  vectors  aligned  with  the 
x y z ° 

inertial  ecliptic  coordinate  axes. 


Denoting  the  elements  of  by  Q!^>  we  will  define 

Q|x  = E[6AV^2],  Q22  = E[6AV^2],  = E[6AV^2] 

Qiz  = Qjl  = E^v;  6AVp 

q;3  - q31  ■ E[54v;  64v;i 

^23  ■ «32  • E[Mv;  5iv;i 


(8.102) 
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Substituting  equations  (8.95),  (8.96),  and  (8.97)  into 
(8.102)  and  assuming  all  execution  error  sources  to  be  uncor- 
related, yields 

Q'  = ?'  AV'2  + (p'2  AV'2  6a'6a'  AV'2  AV'2  66  ' 66  ' 

X11  ^ x y ^ \ y x z 


2AV' 


+ 2p ' AV'  AV'  AV'  6a'  66'  I + C'l  p'AV'  Act'  + AV'  AV'  66' 

xyz  / y \ y xz 


(8.103) 


Q'  = AV'2  + -tit  /aV'2  AV'2  66'  <56'  + p'2  AV'2  6a'  6a' 

22  y y \ y z x 


v 2AV ' / a a 

- 2p ' AV'  AV'  AV'  6a'  66'  I + ?'(AV'  AV'  66'  - p'  AV'  6a' 

xyz  / y \ y z x 


Q'  = c AV'2  + y'2  66*66'  - 2 AV'  y'  5'  66' 
33  z z 


(8.104) 

(8.105) 


■ «2i  ■ «'  + ^ 


2 AV'  AV'  AV'  66'  - p'  /aV'2  - AV'2\  6a' 
xyz  \ x y ) 


+ 


- p'2  AV'  AV'  6a'  6a'  + p'  AV’  (AV'2  - AV'2\6a'  66' 
x y z \ y x ) 


+ AV'  AV'  AV'2  66'  66' 
xyz 


(8.106) 


*13 


Q'  = C'  AV'  AV'  + ?' 
31  x z 


AV' 

z 


r (p ' AV'  6a'  + AV'  AV'  66')-  y'  A$'  66' 
\ y x z / x 


p'  AV'  6a'  66'  - AV'  AV'  66'  66' 

X X z 


(8.107) 


Q23  Q32 


5'  AV'  AV'  + 

y z 


AV' 


AV'  AV'  66'  - 

y z 


p'  AV'  6a'  )-  y'  AV'  66' 
x / y 


+ p'  AV'  6a'  66'  - AV'  AV'  66'  66' 
x y z 


(8.108) 
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where 


and 


c = k'k' 


+ — r k'  s' 


+ 


s ' s ' 


(8.109) 


(8.110) 
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9.  PROBE  TARGETING,  ERROR  ANALYSIS,  AND  SIMULATION 


9.1  Introduction 

Main  probe  targeting  proceeds  via  the  same  Newton-Raphson  pro- 
cedures as  do  all  the  other  targeting  options.  Only  the  target 
parameters  themselves  are  different.  They  are  time,  latitude, 
and  longitude  at  impact  on  the  target  planet.  The  last  two  of 
these,  like  inclination  and  radius  of  closest  approach,  are  treated 
by  first  transforming  them  into  an  equivalent  pair  of  impact 
plane  coordinates,  B*T  and  B*R. 

Miniprobe  targeting,  on  the  other  hand,  is  essentially  dif- 
ferent from  all  the  other  targeting  problems  solved  in  NOMNAL. 

First,  its  controls  are  not  simply  three  orthogonal  velocity  com- 
ponents but  rather  four  release  variables.  Second,  its  target 
parameters  outnumber  its  controls,  making  it  necessary  to  settle 
for  a minimum-miss  rather,  than  a true  solution.  Miniprobe  targeting 
is  therefore  treated  in  Section  9.2  of  this  chapter. 

Probe  error  analysis  and  simulation  is  based  directly  on  the 
theory  presented  in  Chapters  5,  6,  and  7.  The  only  new  features 
are  (1)  the  computation  of  an  execution  error  covariance  for  the 
miniprobe  spin  release  maneuver,  and  (2)  the  transformations  of 
states  and  covariances  at  entry  to  the  form  required  by  the  LTR* 
program.  The  details  of  the  error  analysis  and  the  simulation  of 
probe  release  are  presented  in  the  analysis  sections  of  subroutines 
PROBE  and  PROBS,  respectively.  The  computation  of  the  spin  re- 
lease execution  error  covariance  is  treated  in  the  analysis  of 
MINIQ . Finally,  subroutine  NTRY  describes  the  transformation  of 
the  STEAP-generated  state  and  covariance  into  a form  suitable  for 
the  LTR  program.  Thus  probe  error  analysis  and  simulation  re- 
quire no  further  treatment  in  the  current  chapter. 

9.2  Miniprobe  Targeting 
9.2.1  Introduction 

The  problem  of  finding  the  optimum  miniprobe  release  controls 
to  achieve  impacts  as  near  as  possible  to  the  respective  three  de- 
sired miniprobe  entry  sites  divides  naturally  into  three  parts: 

(1)  model  formulation,  (2)  initial  iterate  generation,  and  (3) 
minimum-miss  optimization.  NOMNAL's  treatment  of  each  of  these 
three  areas  is  surveyed  below.  For  a more  detailed  discussion, 
the  STEAP  Programmer's  Manual  should  be  consulted  under  the  ap- 
propriate subroutine. 


Lander  Trajectory  Reconstruction. 
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9.2.2  Model 


The  following  bus/miniprobe  configuration  is  assumed.  Three 
miniprobes  are  suspended  on  booms  from  the  bus  in  such  a manner 
that  they  form  the  vertices  of  an  equilateral  triangle  centered 
about,  and  perpendicular  to,  the  bus  spin  axis.  These  miniprobes 
are  then  assumed  to  be  released  simultaneously  so  their  three  re- 
spective velocities  relative  to  the  bus  form  an  equilateral  tri- 
angle . 

Only  four  release  control  variables  are  assumed  available  to 
the  designer  in  achieving  the  six  target  variables  of  declination 
and  right  ascension  at  impact  for  each  of  the  three  miniprobes. 
They  are  (1)  the  release  roll  angle,*  (2)  the  tangential  velocity 
at  release,  (3)  the  ecliptic  declination  of  the  spin  axis,  and 
(4)  the  ecliptic  right  ascension  of  the  spin  axis.  Three  other 
potential  controls  are  (a)  the  release  time  and  (b)  and  (c)  the 
declination  and  right  ascension  of  the  impact  site  of  the  existing 
bus  trajectory  at  release.  Controls  (2)  and  (a)  to  first  order 
have  exactly  the  same  effect  on  the  miniprobe  impact  site  distri- 
bution. Hence  both  cannot  be  used  in  a minimum-miss  algorithm 
based  on  linear  sensitivities  alone.  On  the  basis  of  projected 
Planetary  Explorer  mission  profiles,  it  was  decided  to  fix  the 
release  time  rather  than  the  tangential  velocity  at  release.  The 
other  two  controls  could,  however,  be  added  to  the  existing  al- 
gorithm with  only  moderate  difficulty.  The  vector  of  release 
controls  will  be  denoted  in  what  follows  by  u. 

To  make  use  of  the  linear  dependence  of  B*T  and  B-R  on  the 
release  controls  and  to  avoid  the  difficulty  of  defining  a pseudo- 
impact point  when  a miniprobe  misses  the  planet,  all  of  the  tar- 
geting is  done  in  the  impact  plane.  The  correspondence  between 
actual  impact  points  on  the  planet  and  the  fictitious  asymptote 
pierce  points  in  the  R*T  plane  is  shown  pictorially  in  Figure  9.1. 
If  the  gravitational  attraction  of  the  target  planet  and  the  sun 
could  be  turned  off  at  the  planet's  sphere  of  influence,  the  ve- 
hicle would  follow  a trajectory  approximately  coincident  with  the 
asymptote  to  its  actual  trajectory.  The  shortest  vector  from  the 
planet  to  the  asymptote  or  force-free  trajectory  is  called  the  B 
vector.  The  unit  vector  originating  at  the  planet  center  and 
pointing  in  the  direction  of  the  asymptote  or  hyperbolic  excess 


* 

The  roll  angle  is  measured  about  the  spin  axis  in  the  direc- 
tion of  rotation  from  the  vector,  which  is  the  cross-product  of 
the  spin  vector  with  the  ecliptic  pole  vector. 
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R-T  PLANE 


Figure  9.1  Schematic  Visualization  of  RT  Plane  Mini  probe  Targeting 


velocity  vector  is  called  the  vector.  The  T vector  is  the  cross- 
product  of  the  S vector  with  the  ecliptic  pole  vector  K,  while  the 
R vector  is  the  cross-produce  of  the  S_  vector  with  the  vector. 
Naturally  the  B_  vector  lies  in  the  R-T  or  "impact"  plane  and  is 
conveniently  resolved  into  the  components  B‘T  and  B*R  along  the 
T and  R axes  respectively.  Each  desired  miniprobe  impact  site 
is  converted  into  a corresponding  B'T^  - B*R^  pair  using  the  hy- 
perbolic excess  velocity  vector  for  the  miniprobe  targeted  to  it. 

Next  the  actual  B-plane  coordinates,  B*T  and  B*R  , are  calculated. 

A A 

An  impact-plane  miss  vector  can  then  be  defined  as 


C1  <b-td-b-ta>i 
C2  (B'TD  - B-V2 

* ' I C3  «-Td  - “'Vs 

C1  ' WA>1 

C2  - B ' 2 

C3  (B'RD-B-RA>3 


(9.1) 


where  the  numeric  subscripts  identify  the  probes.  The  constants 
Cf,  C and  are  simply  weighting  factors  assigned  by  the  user 

to  the  respective  desired  miniprobe  impact  sites.  The  magnitude 
of  a given  factor  should  be  in  approximate  proportion  to  the  im- 
portance of  a nearby  impact  to  the  corresponding  target  site. 

The  miss  index,  y,  can  then  simply  be  taken  as  the  norm  squared 
of  the  miss  vector;  i.e., 


y = i.  • (9.2) 

Two  trajectory  propagation  models  are  available  in  the  mini- 
probe targeting  routine.  The  first  is  a high-speed  conic  scheme, 
while  the  second  is  a time-consuming  virtual-mass  procedure.  The 
n-body  integration  computer  time  requirements  are  aggravated  in 
miniprobe  targeting  by  the  fact  that  each  propagation  entails  the 
integration  of  three  separate  trajectories.  Hence  one  minimum- 
miss  iteration  on  n release  controls  demands  3(n+l)  trajectory  in- 
tegrations. Here  3n  of  the  integrations  are  required  to  generate 
(by  perturbation)  the  Jacobian  sensitivity  matrix  of  the  miss  vec- 
tor with  respect  to  the  release  controls,  while  the  remaining  three 
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are  necessary  to  evaluate  the  miss  vector  for  the  new  iteration. 
Fortunately  a given  set  of  release  controls  produce  the  same  im- 
pact time,  declination,  right  ascension,  velocity,  flightpath  angle, 
and  angle  of  attack  for  both  models  to  within  1%.  However,  the  set 
of  minimum-miss  controls  for  the  two  models  differ  substantially. 

In  particular  the  optimal  spin  axis  direction  can  differ  by  as 
much  as  10°  between  the  two  models.  Lucklily,  when  the  optimal 
conic  release  controls  are  propagated  with  the  n-body  integrator, 
the  miss  index  is  only  slightly  larger  than  when  the  optimal 
virtual-mass  controls  are  so  propagated.  It  would  appear  then 
that  the  conic  propagation  model  is  more  than  adequate  for  most 
preliminary  mission  analysis  work. 

The  conic  model  miniprobe  propagation  mode  is  somewhat  in- 
volved. First,  the  virtual-mass  trajectory  of  the  bus/miniprobe 
combination  is  propagated  to  impact.  The  resulting  impact  state 
is  then  used  to  generate  an  osculating  planetocentric  conic  ac- 
curately representing  the  near-planet  trajectory.  This  near- 
planet conic  is  then  propagated  backward  to  the  nominal  time  of 
release,  and  the  resulting  conic  state  is  taken  as  the  nominal  re- 
lease state.  Hence  the  conic  and  virtual-mass  trajectories  are 
matched  at  impact  rather  than  release.  Velocity  perturbations 
are  then  applied  to  the  conic  nominal  release  state  and  are  propa- 
gated forward  conically  to  generate  sensitivity  matrices.  These 
matrices  are  then  manipulated  by  the  minimum-miss  algorithm  to 
yield  a set  of  release  controls  that  minimize  the  miss  index. 

The  virtual-mass  propagation  model  is  simpler  in  concept  than 
the  conic  scheme  but  more  difficult  in  execution.  All  trajectories, 
both  nominal  and  perturbed,  are  simply  propagated  by  integrating 
their  heliocentric  state  vectors.  The  virtual-mass  method  is  ob- 
jectionable not  only  because  of  its  prohibitive  running  time  but 
also  because  of  its  limited  resolution.  Roundoff  error  limits 
the  accuracy  of  the  sensitivity  matrix  of  the  miss  vector  to  the 
release  controls,  thereby  limiting  the  precision  to  which  the 
controls  can  be  made  to  converge. 

Both  of  these  difficulties  could  probably  be  eliminated  by 
generating  the  sensitivities  analytically  rather  than  by  perturba- 
tion. It  seems  reasonable  to  suspect  that  analytical  sensitivities 
based  on  the  two-body  model  would  suffice  to  produce  reasonable 
convergence  in  the  n-body  propagation.  The  time  required  to  com- 
pute the  sensitivies  analytically  would  be  negligible  compared  to 
that  required  to  calculate  them  numerically.  Hence  the  generation 
of  n virtual-mass  optimal  release  controls  could  be  accelerated 
n-fold.  However,  with  the  current  virtual-mass  perturbative  sen- 
sitivity matrix  generation,  the  slight  miss  index  improvement 
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achieved  with  optimal  virtual-mass  controls  will  seldom  justify 
their  increased  cost  in  terms  of  computer  running  time. 

The  miniprobe  propagation  process  is  handled  by  the  subroutine 
TPPROP.  Given  a set  of  release  controls  and  a spin  axis  orientation 
mode,  it  generates  the  miss  vector  by  propagating  the  miniprobes 
to  impact  according  to  either  the  conic  or  virtual-mass  models  as 
desired. 

9.2.3  Initial  Control  Estimate 

To  apply  an  iterative  miss  index-minimizing  algorithm,  an 
initial  estimate  of  the  control  vector  must  be  devised.  Further, 
since  the  selected  algorithm  treats  the  miss  vector  j>  as  a linear 
function  of  the  control  vector  _u,  the  estimate  must  be  in  a region 
about  the  true  minimum-miss  point  throughout  which  reasonable 
linearity  prevails.  For  this  reason  an  elaborate  initial  control 
estimate  was  designed  for  the  conic  model  iteration.  The  converged 
conic  model  controls  then  serve  as  the  initial  iterate  in  the 
virtual-mass  iteration. 

The  initial  estimates  for  two  of  the  controls  (the  spin  axis 
orientation  angles)  depend  of  course  on  the  spin  axis  orientation 
mode.  In  three  of  the  four  possible  modes  the  ecliptic  decina- 
tion  and  right  ascension  of  the  spin  axis  at  release  are  fixed 
rather  than  free  controls.  Hence  no  initial  estimates  for  them 
need  to  be  provided.  In  the  remaining  mode,  however,  both  of 
these  controls  are  free,  and  the  initial  estimates  provided  for 
them  are  simply  those  that  bring  the  spin  axis  into  coincidence 
with  the  bus  velocity  vector  at  release.  This  orientation  was 
chosen  for  the  initial  estimate  since  it  produces  the  widest  dis- 
tribution of  miniprobe  entry  sites  for  a given  combination  of  the 
remaining  two  controls. 

An  initial  estimate  for  the  other  two  controls  (the  release 
roll  angle  and  the  tangential  velocity  at  release)  are  generated 
by  merely  targeting  the  first  miniprobe  to  the  miniprobe  target 
site  nearest  the  bus  impact  point  for  the  bus  trajectory  existing 
at  release.  Using  a single  Newton-Raphson  step,  the  release  ve- 
locity increment  perpendicular  to  the  bus  spin  axis  that  would 
carry  the  first  miniprobe  to  the  nearest  desired  miniprobe  site 
is  approximated.  From  this  increment,  the  corresponding  unique 
pair  of  controls  (1)  and  (2)  is  calculated.  A more  accurate  tar- 
geting of  the  first  miniprobe  is  unjustified  since  this  preliminary 
targeting  process  ignores  the  remaining  two  miniprobes. 
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The  initial  control  estimate  generation  is  carried  out  en- 
tirely in  the  subroutine  TPRTRG. 

9.2.4  Minimum -Miss  Algorithm 

Minimizing  the  miss  index  defined  in  equation  (9.2)  is  clearly 
a weighted  least-squares  optimization  problem.  Gauss  developed 
an  extremely  efficient  pseudoinverse  algorithm  for  treating  such 
problems  when  the  miss  vector  is  approximately  a linear  function 
of  the  control  vector  u.  * The  Gauss  procedure,  which  is  merely 
the  exact  one-step  solution  to  the  problem  for  the  linear  case, 
requires  that  the  control  correction 

Au  = - (JTJ)_1  JT  ± (9.3) 

be  applied  at  each  iteration  where  J is  the  Jacobian  matrix  of 
the  miss  vector  with  respect  to  the  control  vector;  i.e.. 


1 m (9.4) 

1 , . . . ,n 
m > n 

It  should  be  evident  that  the  Gauss  least-squares  procedure  then 
degenerates  to  the  Newton-Raphson  algorithm  when  the  number  of 
controls,  n,  is  equal  to  the  number  of  constraints,  m. 

The  linear  transformation  applied  to  in  the  control  correc- 
tion formula  (9.3)  will,  of  course,  be  recognized  as  the  left 
pseudoinverse  of  J that  is  known  to  give  the  minimum  ^-nom  solu- 
tion to  the  system 

-±  = J^u  • (9.5) 

The  least-squares  property  of  the  Gauss  formula  is  then  an  im- 
mediate consequence  of  this  fact.  Alternatively  the  correction 
formula  can  be  derived  directly  by  expanding  the  identity 

Vy  = 2JT  (9.6) 


i = 

j = 


See  Reference  18. 


104-29 


in  a Taylor  series  about  the  current  control  vector  iterate  _u, 
neglecting  all  second  and  higher  order  terms,  and  requiring  that 

Vy  (u  + Au)  = 0 (9.7) 

Heuristically  speaking,  the  Guass  or  pseudo-inverse  scheme  operates 
by  constructing  hyperplanes  tangent  at  the  current  iteration  point 
to  the  manifolds  to  constant  miss  for  each  of  the  components  of  the 
miss  vector.  The  scheme  then  extrapolates  to  the  "zero-miss"  hyper- 
planes assuming  that  all  of  the  manifolds  of  constant  miss-vector 
components  are  uniformly  spaced  hyperplanes.  Finally  it  solves  for 
the  unique  point  that  is  so  located  as  to  minimize  the  sum  of  the 
squares  of  its  distances  from  the  respective  "zero  miss"  hyperplanes 

The  linearity  of  the  miniprobe  targeting  makes  it  a prime 
candidate  for  the  Gauss  algorithm.  Nonetheless  considerable  non- 
linearity can  arise  in  the  minimprobe  release  problem  because  of 
a poor  original  control  estimate.  In  such  a case  the  Gauss  scheme 
could  easily  diverge  because  of  its  unjustified  linear  extrapolation 
To  cope  with  this  problem,  a best-step  steepest-descent  option  was 
incorporated  in  the  least-squares  routine.  This  option  is  used 
when  either  of  two  situations  arise  indicating  nonlinearity: 

(1)  the  Gauss  control  correction  is  larger  in  norm  than  some  in- 
put upper  bound,  or  (2)  the  Gauss  step  actually  increases  the 
miss  index  over  the  previous  iterate. 

The  logic  of  the  steepest  descent  scheme  is  straightforward. 
First  the  gradient  to  the  miss  index  is  calculated  from  the  Jacobian 
matrix  of  the  niss  vector  with  respect  to  the  control  vector  and 
the  miss  vector  itself  as 


Vy  = 2JT  ± . (9.8) 

Next  a search  is  conducted  in  the  negative  gradient  direction  un- 
til the  miss  index  is  observed  to  begin  increasing.  Then  a cubic 
polynomial  is  fit  to  the  miss  index,  y,  as  a function  of  the  step 
length.  A,  in  the  search  direction  by  exactly  matching  function 
values  at  A = 0,  A a a,  and  A = a/2  and  slopes  at  A = 0 where  a 
is  that  particular  step  size  where  y is  first  found  to  increase. 

Then  the  abscissa  value,  A , of  the  minimum  of  the  fitted  poly- 

m 

nomial  is  computed.  Finally  the  control  correction  is  taken  to  be 

AU  a -A^Vy/l | Vy | | . (9.9) 

The  convergence  of  the  scheme  is  only  asymptotic,  i.e.,  one  can 
only  guarantee  that  the  minimum-miss  control  vector  can  be  arbi- 
trarily accurately  approximated  by  taking  a sufficiently  large 


number  of  iterations.  Nevertheless,  the  steepest-descent  algo- 
rithm seems  to  be  the  best  available  for  extremely  nonlinear  per- 
formance indices  since  it  involves  no  linear  extrapolation  and  since 
it  searches  in  the  only  direction  in  which  improvement  is  assured. 
Its  poor  terminal  convergence  is  no  handicap  in  the  hybrid  weighted 
least-squares  routine  used  in  NOMNAL  since  once  the  iteration 
sequence  falls  inside  a suitably  linear  region  about  the  miss 
index  minimum,  the  rapidly  convergent  Gauss  scheme  will  take  over. 

The  convergence  criterion  in  either  mode  of  the  least-squares 
algorithm  is  the  same.  Adequate  convergence  is  assumed  when  a 
weighted  sum  of  the  length  of  the  change  in  the  control  vector 
and  the  length  of  the  change  in  the  control  vector  and  the  magni- 
tude of  the  change  in  this  miss  index  fall  below  a preassigned 
value,  e;  i.e.. 


Cx  | |Au| | + C2  | Ay | < e . (9.10) 

With  the  units  of  u being  radians  or  decameters/sec*  and  those  of  y 
being  km2,  and  C ^ are  currently  fixed  inside  the  program  at 

10,000  and  1,  respectively.  Presently  e is  input  by  the  user 
with  a suggested  value  being  1. 

The  entire  iterative  miss  minimization  process  is  conducted 
in  the  subroutine  GAUSLS. 


These  units  were  selected  so  that  components  of  u are  all  of 
the  same  order  of  magnitude.  Numerical  problems  can  arise  if  this 
precaution  is  not  taken. 
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10.  INDIVIDUAL  SUBROUTINE  ANALYSES 


This  chapter  is  composed  of  three  major  items.  In  Table  10.1 
all  the  subroutines  of  STEAP  II  are  listed  by  category.  In  Table 
10.2  an  index  of  the  subroutines  is  provided  with  a brief  summary 
of  the  function  of  each  subroutine,  again  in  categorical  order. 

The  remainder  and  bulk  of  the  chapter  supplies  the  analytical 
documentation  of  each  technical  subroutine  in  alphabetical  order. 


Table  10.1  STEAP  II  Subroutine 


I.  Virtual-Mass  Subroutines 

A.  Conic  B.  Ephemeris  C.  Propagation  D.  Input/Output 


1. 

CAREL 

1.  TIME 

1.  VMP 

1. 

TRAPAR 

2. 

ELCAR 

2.  BLOCK  DATA 

2.  ESTMT 

2. 

INPUTZ 

3. 

IMPACT 

3.  ORB 

3.  VECTOR 

3. 

PRINT 

4. 

SOIPS 

4.  EPHEM 

4.  VMASS 

4. 

SPACE 

5.  CENTER 

5. 

NEWPGE 

6.  PECEQ 

7.  EULMX 

8.  SUBSOL 


II.  NOMNAL  Subroutines 


Executive 

B.  Zero  Iterate 

C.  Targeting 

1.  EXCUTE 

1.  BAT CON 

7.  LUNTAR 

1.  DESENT 

2.  GIDANS 

2.  FLITE 

8.  MULCON 

2.  KTROL 

3.  MPPROP 

3.  HELIO 

9.  MULTAR 

3.  TARGET 

4.  NOMNAL 

4.  LAUNCH 

10.  SERIE 

4.  TARMAX 

5.  PRELIM 

6.  TRJTRY 

5.  LUNA 

6.  LUNCON 

11.  ZERIT 

5.  TAROPT 

Insertion 

E.  Pulsing  Arc 

F. 

Miniprobe  Targe 

1.  COPINS 

1.  (BATCON) 

1.  SACOCS 

2.  INSERS 

2.  PERHEL 

2.  TPPROP 

3.  NONINS 

3.  PREPUL 

4.  PULSEX 

3.  TRRTRG 

Mathematical 

H.  Conic 

I. 

Ephemeris 

Functions 

Operations 

and 

1.  DINCOS 

6.  SCAD 

1.  CAREL 

6.  HYPT 

1. 

EPHEM 

2.  DINS IN 

7.  SCAR 

2.  CONCAR 

7.  IMPACT 

2. 

ORB 

3.  JACOB 

8.  THPSOM 

3.  DIMPCP 

8.  IMPCT 

3. 

PECEQ 

4.  MATIN 

9.  USCALE 

4.  ELIPT 

9.  SPHIMP 

4. 

SUBSOL 

5.  MATPY 

10.  UxV 

5.  HPOST 

10.  STIMP 
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III.  ERRAN  and  SIMUL  Subroutines 


A.  Executive 

C.  Navigation 

D.  Event 

E.  Input/Outp 

1.  ERRAN 

1.  NAVM 

1.  SETEVN 

1. 

DATA 

2.  SIMUL 

2.  GNAVM 

2.  SETEVS 

2. 

DATA1 

3.  GAIN1 

3.  PRED 

3. 

GDATA 

B.  Dynamic  Model 

4.  GAIN 2 

4.  PRESJ.M 

4. 

SKEDM 

5.  SCHED 

5.  BEPS 

5. 

DAT  AS 

1.  NTM 

6.  TRAKM 

6.  BATCON 

6. 

DATA1S 

2.  NTMS 

7.  TRAKS 

7.  ZRANS 

7. 

CONURT 

3.  PSIM 

8.  TARPRL 

8.  ATANH 

8. 

TRANS 

4.  NDTM 

9.  STAPRL 

9.  BPLANE 

9. 

CORREL 

5.  PLND 

10.  MEMO 

10.  QUASI 

10. 

STMPR 

6.  MUND 

11.  MENOS 

11.  GUI DM 

11. 

SUB1 

7.  PCTM 

12.  BIAS 

12.  GUISIM 

12. 

TITLE 

8.  CONCZ 

13.  RNUM 

13.  GUID 

. 13. 

GPRINT 

9.  CASCAD 

14.  DYNO 

14.  GUIS 

14. 

MOMENT 

15.  DYNOS 

15.  VARADA 

15. 

PRINT3 

16.  GHA 

16.  VARSIM 

16. 

PRNTS3 

17.  JACOBI 

17.  PARTL 

17. 

PRINT4 

18.  HYEIS 

18.  BIAIM 

18. 

PRNTS4 

19.  EIGHY 

19.  POICOM 

20.  MEAN 

20.  QCOMP 

21.  SAVMAT 

21.  NONLIN 

22.  PULCOV 

23.  EXCUT 

24.  EXCUTS 

25.  PROBE 

26.  PROBES 

27.  MIN IQ 

28.  NTRY 

29.  GENGID 

30.  ATCEGV 

31.  GQCOMP 
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Table  10.2  STEAP  II  Subroutine  Summaries. 


Subroutine 


Function 


I.  Virtual-Mass  Subroutines 


Conic 

1. 

CAREL 

Convert  a Cartesian  state  to  conic 
elements 

2. 

ELCAR 

Convert  conic  elements  to  a Cartesian 
state 

3. 

IMPACT 

Compute  the  impact-plane  parameters 

4.  SOIPS 
Ephemeris 

Conically  extrapolate  from  the  nearest 
integration  state  to  obtain  impact 
data  at  the  SOI  and  at  the  planet 
surface 

1. 

BLOCK  DATA 

Set  the  emphemeris  constants  of  the 
gravitational  bodies 

2. 

CENTER 

Convert  the  states  of  bodies  to 
barycentric  coordinates 

3. 

EPHEM 

Compute  the  inertial  state  of  a 
gravitational  body  at  a given  time 

4. 

EULMX 

Compute  the  rotational  transforma- 
tion matrix  from  the  Euler  angles 

5. 

ORB 

Compute  the  orbital  elements  of  a 
gravitational  body  at  a given  time 

6. 

PECEQ 

Compute  the  transformation  matrix 
from  ecliptic  to  equatorial  coor- 
dinates 

7. 

SUBSOL 

Compute  the  transformation  matrix 
from  ecliptic  to  subsolar  coordinates 

8. 

TIME 

Convert  Julian  dates  epoch  1900  to 
calendar  dates  or  vice  versa 
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Subroutine 


Function 


C.  Propagation 

1.  ESTMT  Determine  final  position  and  magnitude 

of  the  virtual  mass  on  the  current 
step 

2.  VECTOR  Compute  the  final  position  of  the 

spacecraft  on  the  current  step 

3.  VMASS  Determine  the  virtual-mass  data  for 

the  current  step 

4.  VMP  Direct  the  virtual-mass  trajectory 

propagation 

D.  Input/Output 

1.  INPUTZ  Convert  the  input  data  into  a form  on 

which  VMP  can  operate 

2.  NEWPGE  Print  headings  for  each  new  page  in 

VMP  printout 

3.  PRINT  PRINT  periodic  trajectory-status 

data 

4.  SPACE  Space  paper  keeping  tracking  of 

paging 

5.  TRAPAR  Compute  and  record  navigation  param- 

eter data 

II.  NOMNAL  Subroutines 


A.  Executive 

1. 

EXCUTE 

Control  the  execution  of  a velocity- 
increment  trajectory  correction 

2. 

GIDANS 

Control  the  computation  of  a velocity 
increment  trajectory  correction 

3. 

MPPROP 

Generate  a time  history  of  the  main- 
probe  trajectory 
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4. 

NOMNAL 

Control  the  generation  of  the  nominal 
trajectory  (main  program) 

5. 

PRELIM 

Perform  preliminary  data  processing 
for  NOMNAL 

6. 

TRJTRY 

Propagate  the  nominal  trajectory 
to  the  next  guidance  event 

Zero  Iterate 

1. 

BATCON 

Propagate  a conic  trajectory  by  means 
of  the  universal  conic  functions 

2. 

FLITE 

Obtain  the  solution  to  Lambert's 
time-of -flight  equation 

3. 

HELIO 

Compute  the  heliocentric  phase  of 
the  interplanetary  zero  iterate 

4. 

LAUNCH 

Compute  the  launch  phase  of  the  in- 
terplanetary zero  iterate 

5. 

LUNA 

Control  lunar  zero-iterate  generation 

6. 

LUNCON 

Generate  a patched  conic  lunar  tra- 
jectory 

7. 

LUNTAR 

Control  the  patched  conic  targeting 

8 . 

MULCON 

Generate  the  lunar  multiconic  trajec- 
tory 

9. 

MULTAR 

Control  the  lunar  multiconic  targeting 

10. 

SERIE 

Compute  the  universal  conic  functions 
used  in  FLITE 

11. 

ZERIT 

Control  the  computation  of  the  zero 
iterate 

Targeting 

1. 

DESENT 

Compute  the  interplanetary  velocity 
targeting  corrections  using  the 
descent  scheme 
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2. 

KTROL 

Compute  the  heliocentric  ecliptic 
velocity  corrections  given  the  launch 
planetocentric  velocity  controls 

3. 

TARGET 

Control  the  n-body  targeting 

4. 

TARMAX 

Compute  the  Newton-Raphson  targeting 
matrix 

5. 

TAROPT 

Set  up  the  actual  and  auxiliary  tar- 
get parameter  arrays 

D.  Insertion 

1. 

COPINS 

Compute  the  coplanar  orbit  insertion 
maneuver 

2. 

INSERS 

Control  the  orbit  insertion  computa- 
tion 

3. 

NONINS 

Compute  the  nonplanar  orbit  insertion 

E.  Pulsing  Arc 

1 0 

(BATCON) 

Propagate  a conic  trajectory  by  means 
of  the  universal  conic  functions 

2. 

PERHEL 

Propagate  a perturbed  heliocentric 
conic 

3. 

PREPUL 

Perform  the  preliminary  data  proces- 
sing for  a multiple-pulse  trajectory 
correction 

4. 

PULSEX 

Execute  pulsing  arc 

F.  Miniprobe  Targeting 
1.  SAOCS 


2 . TP PROP 


Compute  the  sines  and  cosines  of  the 
spin-axis  right  ascension  and  decli- 
nation given  the  spin-axis  orientation 
mode 

Propagate  the  three  miniprobe  tra- 
jectories according  to  either  a conic 
or  virtual-mass  model 
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3.  TPRTRG 


Control  the  miniprobe  targeting 
procedure 


Mathematical 

1.  DINCOS 

2.  DINS IN 

3 . JACOB 

4.  MATIN 

5 . MATPY 

6.  SCAD 

7.  SCAR 

8.  THPOSM 

9.  USC ALE 

10.  UXV 

Conic 
1.  CAREL 


Functions  and  Operations 

Calculate  in  degrees  the  inverse 
cosine  of  a real  number 

Calculate  in  degrees  the  inverse 
sine  of  a real  number 

Approximate  by  divided  differences 
the  Jacobian  sensitivity  matrix  of 
a vector-valued  function  with  re- 
spect to  a vector  variable 

Invert  a matrix  of  real-valued 
elements 

Multiply  two  matrices  of  real- 
valued elements 

Calculate  both  the  sine  and  cosine 
of  an  angle  given  in  degrees 

Calculate  both  the  sine  and  cosine 
of  an  angle  given  in  radians 

Find  the  minimum  of  a function  on 
a given  interval  by  cubic  interpolation 

Scale  the  length  of  a three-vector 
to  a specified  real  number 

Calculate  the  vector  product  of  two 
three-vectors 


Convert  a Cartesian  state  to  conic 
elements 

Convert  a conic  state  in  terms  of 
r,  0,  e,  P^  Q,  and  y into  a Cartesian 
state 


2 . CONCAR 


3 . DIMPCP 

4.  ELIPT 

5 . HPOST 

6 . HYPT 


Calculate  the  desired  B-plane  asymptote 
pierce-point  coordinates  given  the  right 
ascension  and  declination  of  a probe 
target  site 

Calculate  the  time  from  periapsis  on 
an  elipse  given  the  true  anomaly 

Calculate  the  radius  and  true  anomaly 
on  a hyperbola  given  the  time  from 
periapsis 

Calculate  the  time  from  periapsis 
on  a hyperbola  given  the  true  anomaly 


7.  IMPACT 


Compute  the  impact-plane  parameters 


8.  IMPCT  For  auxiliary  targeting  compute  actual 

and  desired  B-plane  asymptote  pierce  - 
points  as  well  as  actual  target  values 

9.  SPHIMP  Calculate  the  true  anomaly  and  time 

from  periapsis  at  which  a conic  ap- 
proach trajectory  pierces  a plane to- 
centric  sphere  of  a given  radius 

10.  STIMP  Calculate  the  B-plane  asymptote  pierce- 

point  coordinates  of  a conic  trajectory 
given  a state  upon  it 


Ephemeris 

1. 

EPHEM 

Compute  the  inertial  state  of  a 
gravitational  body  at  a given  time 

2. 

ORB 

Compute  the  orbital  elements  of  a 
gravitational  body  at  a given  time 

3. 

PECEQ 

Compute  the  transformation  matrix 
from  ecliptic  to  equatorial  coordinates 

4. 

SUB SOL 

Compute  the  transformation  matrix 
from  ecliptic  to  subsolar  coordinates 
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III.  ERRAN  and  SIMUL  Subroutines 
A.  Executive 


1.  ERRAN  Control  error  analysis  program  (main 

program) 


2. 

SIMUL 

Control  simulation  program  (main 
program) 

Dynamic  Model 

1. 

NTM 

Control  generation  of  trajectory 
for  ERRAN 

data 

2. 

NTMS 

Control  generation  of  trajectory 
for  SIMUL 

data 

3. 

PSIM 

Control  computation  of  state  transi- 
tion matrix  (STM) 

4. 

NDTM 

Compute  unaugmented  partition  of 
by  numerical  differencing 

STM 

5. 

PLND 

Compute  STM  partition  associated 
ephemeris  biases 

with 

6. 

MUND 

Compute  STM  partition  associated 
gravitational  constants 

with 

7. 

PCTM 

Compute  unaugmented  partition  of 
by  patched  conic  technique 

STM 

8. 

C0NC2 

Compute  unaugmented  partition  of 
by  virtual-mass  technique 

STM 

9. 

CAS CAD 

Compute  unaugmented  partition  of 
by  cascaded  Darby  matrizants 

STM 

Navigation 

1. 

NAVM 

Propagate  covariance  matrices  between 
measurements  and  between  events  in 
SIMUL 

2. 

GNAVM 

Propagate  assumed  and  actual  covariance 

matrices  between  measurements  and  be- 
tween events  in  ERRAN 
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3.  GAIN1 


Compute  the  Kalman  GAIN  matrices 


4. 

GAIN  2 

Compute  the  GAIN  matrices  for  the 
equivalent  recursive  consider  weighted- 
least-squares  filter 

5. 

SCHED 

Select  next  measurement  time  from 
measurement  schedule 

6. 

TRAKM 

Compute  observation  matrices 

7. 

TRAKS 

Compute  observation  matrices  and 
actual  measurements 

8. 

TARPRL 

Compute  target  planet  position 
partials 

9. 

STAPRL 

Compute  station  location  position 
and  velocity  partials 

10. 

MENO 

Compute  assumed  measurement  noise 
covariance  matrix 

11. 

MENOS. 

Compute  assumed  and  actual  measure- 
ment noise  covariance  matrices 

12. 

BIAS 

Compute  actual  measurement  bias 

13. 

RNUM 

Generate  random  numbers 

14. 

DYNO 

Compute  dynamic  noise  covariance 
matrix 

15. 

DYNOS 

Compute  dynamic  noise  covariance 
matrix  and  actual  dynamic  noise 

16. 

GHA 

Compute  Greenwich  hour  angle 

17. 

JACOBI 

Compute  eigenvalues  and  eigenvectors 
of  a matrix 

18. 

HYELS 

Compute  hyperellipsoids 

19. 

EIGHY 

Control  computation  of  eigenvalues , 
eigenvectors,  and  hyperellipsoids 
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106-10 


20.  MEAN 


21.  SAVMAT 
D.  Event 

1.  SETEVN 

2 . SETEVS 

3.  PRED 

4.  PRESIM 

5.  BEPS 

6 . BATCON 

7.  ZRANS 

8 . ATANH 

9 . BPLANE 

10.  QUASI 

11.  GUI DM 

12.  GUI SIM 

13.  GUID 

14.  GUIS 

15 . VARADA 


Propagate  and  update  means  of  actual 
state  or  parameter  deviations  and 
actual  state  of  parameter  estimation 
errors 

Stores  one  vector  in  a second  vector 


Perform  computations  common  to  most 
events  in  ERRAN 

Perform  computations  common  to  most 
events  in  SIMUL 

Perform  prediction  event  in  ERRAN 

Perform  prediction  event  in  SIMUL 

Compute  B-Plane-Related  covariances 
and  state  transition  matrices 

Compute  trajectory  data  at  time  T 
given  position  and  velocity  at  time  0 

Calculate  transcendental  functions 
used  in  the  universal  form  of  Kepler's 
equation 

Find  the  angle  Y whose  TANH  is  X 

Compute  B-plane  parameters 

Perform  quasi-linear  filtering  event 
in  SIMUL 

Perform  guidance  event  in  ERRAN 

Perform  guidance  event  in  SIMUL 

Compute  guidance  and  variation  matrices 
in  ERRAN 

Compute  guidance  and  variation  matrices 
in  SIMUL 

Compute  3VBP  variation  matrix  In  ERRAN 
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16. 

VARSIM 

Compute  3VBP  variation  matrix  in  SIMUL 

17. 

PARTL 

Compute  partials  of  B'T,  B*R,  wrt 
s ta  te 

18. 

BIAIM 

Perform  biased  aimpoint  guidance 

19. 

P 01  COM 

Compute  probability  of  impact 

20. 

QCOMP 

Compute  execution  error  covariance 
matrix 

21. 

NONLIN 

Control  execution  of  nonlinear  gui- 
dance events 

22. 

PULCOV 

Propagate  covariance  matrix  across 
a series  of  pulses 

23. 

EXCUT 

Control  execution  of  pulsing  arc  in 
ERRAN 

24. 

EXCUTS 

Control  execution  of  pulsing  arc  in 
SIMUL 

25. 

PROBE 

Control  execution  of  probe  release 
events  in  ERRAN 

26. 

PROBES 

Control  execution  of  probe  release 
events  in  SIMUL 

27. 

MINIQ 

Compute  execution  error  covariance 
matrix  for  miniprobe  release 

28. 

NTRY 

Compute  entry  parameters,  covariance, 
and  communication  angle 

29. 

GENGID 

Generalized  covariance  technique 
applied  to  guidance  processes 

30. 

ATCEGV 

Compute  eigenvalues  and  eigenvectors 
of  actual  target  condition  2nd  moment 
matrices 

31. 

GQCOMP  | 

Compute  actual  execution  error  statistics 

108 


E.  Input /Output 


1. 

DATA 

Perform  preliminary  computations  and 
read  data  in  ERRAN 

2. 

DATA1 

Continuation  of  DATA 

3. 

GDATA 

Initialized  generalized  covariance 
quantities 

4. 

SKEDM 

Set  up  bus,  main  probe,  and  miniprobe 
measurement  schedules 

5. 

DATAS 

Perform  preliminary  computations  and 
read  data  in  SIMUL 

6. 

DAT  AS  1 

Continuation  of  DATAS 

7. 

CONVRT 

Convert  JPL  injection  conditions 
to  Cartesian  components 

8. 

TRANS 

Compute  coordinate  transformations 

9. 

CORREL 

Compute  and  print  correlation  matrix 
partitions  and  standard  deviations 

10. 

STMPR 

Print  STM  partitions 

11. 

SUB1 

Compute  position  and  velocity  magnitudes 

12. 

TITLE 

Print  titles 

13. 

GPRINT 

Print  actual  estimation  error  statis- 
tics 

14. 

MOMENT 

Convert  2nd  moment  matrices  to  cor- 
relation matrices  and  print  them 

15. 

PRINT3 

Print  basic  cycle  data  in  ERRAN 

16. 

PRNTS3 

Print  ERRAN  summary 

17. 

PRINT4 

Print  basic  cycle  data  in  SIMUL 

18. 

PRNTS4 

Print  SIMUL  summary 
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INDIVIDUAL  SUBROUTINE  ANALYSES 


BATCON- 1 


BATCON  Analysis 


BATCON  is  a conic  propagator  using  the  Battin  universal  variable  formu- 
lation. A total  derivation  is  too  involved  to  be  given  here;  rather 
the  results  of  Battin 's  work  will  be  given  here. 


Let  the  initial  state  of  a point  mass  moving  under  the  influence  of  a 
gravitational  force  //  be  given  by  r , "v*  . It  is  required  to  determine 

the  state  ~r‘,  "v*  at  a time  T units  later.  It  is  useful  to  introduce  the 
parameters 


a 

o 

ot 


r 

o 


v 

0 


r 

o 


(1) 


Battin's  approach  is  to  introduce  a new  independent  variable  x(t)  in  place 
of  time  by  the  relation 


dx  V/7 

dt  * ^TtT  x(0)  * 0 » (2) 


This  parametrization  greatly  simplifies  the  conic  propagation  problem.  For 
suppose  that  the  value  of  x corresponding  to  t = T is  given  by  X,  i.e.  x(T)  = X. 
Then  the  final  state  is  given  by 


where 


~r  = R,(X)  r“  + R_(X)  "v* 
1 o 2 o 

■v  = V.(X)  t + V_(X)  v* 
1 o 2 o 


(3) 


1 1 


R^X)  = 1 - rQ  U2(X) 

vx)  =v^ 

~\f/T 

V (x)  = - U.  (X) 

1 r_  r_  1 

V2(X)  = 1 - 

[roUi(X)+  t0U2(X) 
o 


(4) 


ill 


BATCON-2 


and  where 


sm 


Vo" 


x 


Uq(X)  a cos  CJ  x a >0 
jsh  ~\f~&  x a <0 


= cos 


U (X)  , W*’ 
a 


yx) 


U (X) 


fa. 

s infi\/“  a X 


a 

X-Ujtt) 

a 


a > 0 

ct  < 0 


(5) 


The  problem  is  thus  reduced  to  the  determination  of  X.  X is  generated 
iteratively  by  the  recursive  formulae 


n+1 


= x 


t -V*  t 


n 


= x - Ax 
n 


(6) 


where 


t = r U (x  ) + a U (x  ) + U (x  ) 
v n oln  2n  3n 


r = r U (x  ) + 0 U,(x  ) + U_(x  ) 
n oon  In  2n 


(7) 


To  start  the  process  the  initial  guess  is  set  to 


x. 


i- 


2r 


T + 


6 r 


3 <7  -r(l-ar) 
o o o 


M T > (8) 


-8 

The  program  sets  X = x^  when  the  correction  Ax  is  less  than  10 
It  terminates  if  the  number  of  iterations  exceeds  10® 


References; 

Battin,  R.H.,  Astronautical  Guidance,  McGraw-Hill  Book  Co®, 

New  York,  1964. 

•Battin,  R.  H.  and  Fraser,  D.C.,  Space  Guidance  and  Navigation,  AIAA 
Professional  Study  Series,  1970. 
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BATCON- 3 


BATCON  Flowchart 


3 


BIAIM  Analysis 


Subroutine  BIAIM  performs  biased  aimpoint  guidance  computations.  If 
planetary  quarantine  constraints  are  in  effect  at  injection  or  at  a 
midcourse  correction,  and  if  the  nominal  aimpoint  does  not  satisfy  these 
constraints,  subroutine  BIAIM  will  compute  a biased  aimpoint  and  the 
required  bias  velocity  correction  such  that  the  constraints  are  satisfied 
and  some  performance  functional  is  minimized. 


Aimpoint  biasing  is  performed  in  the  impact  plane  and  as  such  permits 
only  two  degrees  of  freedom  in  the  selection  of  the  biased  aimpoint.  The 
general  aimpoint  in  the  impact  plane  will  be  denoted  by  the  2-dimensional 
vector  ju . , where  the  j-subscript  indicates  that  the  biased  aimpoint 

guidance  event  is  occurring  at  time  t . Three  midcourse  guidance  policies 

are  available  in  STEAP,  and  it  will  be  necessary  to  relate  U to  the 

j 

specific  aimpoint  for  each  of  these  three  policies.  These  relationships 
are  summarized  below: 


(a)  Two-variable  B-plane  (2VBP) : 


n. 

J 


B • T 
B » R 


(b)  Three-variable  B-plane  (3VBP) 


10  0 
0 10 


B * T 
B • R 

tSI 


(c)  Fixed- time-of-arrival  (FTA) : 


(1) 


(2) 


(3) 


where  r^  is  the  nominal  closest  approach  position  of  the  spacecraft 

relative  to  the  target  planet.  Coordinate  transformation  A projects 
the  3-dimensional  vector  r^  (referred  to  ecliptic  coordinates)  into 

an  equivalent  FTA  impact  plane  which  is  defined  to  be  the  plane 
containing  r^  and  perpendicular  to  the  spacecraft  closest  approach 

velocity  v^  relative  to  the  target  planet.  If  the  ecliptic 

coordinates  of  r_.  and  v_.  are  denoted  by  r , r , r and  v , 

CA  CA  x y z x 

v , v , respectively,  then  the  transformation  A is  given  by 

y z 
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Spacecraft  state  variations  at  tj  are  related  to  airapoint  variations 
(target  condition  variations)  by  the  variation  matrix  T]  , which  is  always 

j 

available  prior  to  calling  BIAIM.  Thus,  the  statistical  state  dispersions 
about  the  nominal  following  the  guidance  correction  at  t.  and  represented 

+ ^ 

by  the  control  covariance  P , can  be  related  to  the  dispersions  about 

j + 

the  nominal  aimpoint  represented  by  W^  according  to  the  equation 

+ + T 

w.  = rj  P-  n.  (5) 


The  control  covariance  P is  computed  from 

j 


= P, 


0 l 0 


1 Qj 


where  P^  is  the  knowledge  covariance  prior  to  the  guidance  event  and 

rJ  3 

Qj  is  the  execution  error  covariance. 

Transformation^  employed  in  equations  (1)  through  (3)  can  also  be  employed 
to  project  Wj  into  the  impact  plane.  The  resulting  projection  is  denoted 

by  the  covariance  -/l . , and  is  obtained  from  W.  according  to  the  following 

j 3 

equations : 

(a)  2VBP  ; A = W+  (7) 


(b)  3VBP 


1,00  W 

0 10 


0 0 


(c)  FTA 


+ T 
AW.  A 
J 
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With  covariance  A.  available,  it  is  now  possible  to  compute  the 

j 

probability  of  impact  P0I.  Assuming  the  probability  density  function 
associated  with  A is  gaussian  and  nearly  constant  over  the  target 

j 

planet  capture  area  permits  us  to  compute  P0I  using  the  equation 


2 

P0I  = 7V  Rc  P 


(10) 


where  R is  the  target  planet  capture  radius  and  p represents  the 
c 

gaussian  density  function  evaluated  at  the  target  planet  center  and  is 
given  by 


p i - exp 

2 7T  | A | 2 


1 

2 


_»  * 


(ID 


The  nominal  impact  plane  aimpoint  is  denoted  by  fl  . Subroutine  BIAIM 
calls  subroutine  P0IC0M  to  perform  the  computations  involved  in  equations 
(7)  through  (11). 


Capture  radius  R is  simply  the  physical  radius  R of  the  target 
c p 

planet  if  the  FTA  guidance  policy  is  employed,  while  for  the  two  B-plane 
policies  the  capture  radius  is  given  by 


R 


(12) 


where  jLl  ^ is  the  target  planet  gravitational  constant  and  Voo  is  the 
hyperbolic  excess  velocity. 

If  the  probability  of  impact  P0I  does  not  exceed  the  permissible  impact 
probability  P^  , and  if  the  nominal  aimpoint  has  not  been  previously 

biased,  we  simply  return  to  subroutine  GUIDM  (or  GUISIM) . If^the  nominal 
aimpoint  has  been  previously  biased,  a velocity  correction  AV^g  required 

to  remove  that  bias  is  computed  prior  to  returning.  But  if  P0I  exceeds 

P , an  aimpoint  bias  5 flA  and  the  associated  bias  velocity  correction  AV 
I J Bj 

must  be  computed.  Before  describing  the  details  of  the^  biasing  technique 
it  is  neces-sary  to  define  the  relationship  between  AV.  and  5 for 
linear  midcourse  guidance  policies.  J 

Linear  impulsive  guidance  policies  have  form 

-A-  ^ 

av  . = r.  ax  (i3) 

3 1 j 
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where 


r is  the  guidance  matrix  and  5X  is  the  spacecraft  state 

j j 

deviation  from  the  targeted  nominal  trajectory.  (These  guidance  policies 
are  discussed  in  more  detail  in  the  subroutine  GUIS  analysis  section.) 
Such  guidance  policies  can  be  readily  generalized  to  account  for  changes 
in  the  target  conditions  from  their  nominal  values.  This  generalized 
version  of  equation  (13)  has  form 


AV.  - T 5X  + Mr  6*1 

J J j j j 


(14) 


where  Mr  can  also  be  referred  to  as  a guidance  matrix.  For  the  purposes 
of  the  BIAIM  analysis,  we  shall  assume  that  6*1.  in  equation  (14)  is 
always  an  aimpoint  change  in  the  impact  plane.  Thus,  Mr.  will  be  a 3x2 
guidance  matrix.  The  derivation  of  the  Mr  matrix  is  quite  similar  to 
the  derivation  of  the  r.  matrix  and  will  not  be  presented  here.  If  we 

j 

partition  the  previously  discussed  variation  matrix  V as  follows: 

j 


V.  = 
J 


K ! "2] 


(15) 


then  the  Mr,  matrices  for  the  three  midcourse  guidance  policies  are 

j 

given  by  the  following  equations: 


(a)  2VBP 

(b)  3VBP 


(c)  FTA 


T T - 1 

* . n2  („2„2 


xj/  = n 


1 0 

0 1 

0 0 


Mr  = 


„ - 1 T 
V A 


(16) 

(17) 


(18) 


If  an  aimpoint  bias  were  to  be  removed  at  time  t.  , the  required  velocity 
correction  would  be  given  by  J 


AV 


RBj 


- Mr  6*1 

j j 


(19) 


If  an  aimpoint  bias  were  to  be  imparted  at  time  t.  , the  bias  velocity 
correction  would  be  given  by 


AVb  = Mr  6*1 

j J J 


(20) 
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If  an  aimpoint  bias 

i2) 

aimpoint  bias 
correction  would  be  j 


is  to 
iven  by 


had  been  previously  imparted,  and  if  a new 
be  imparted,  then  the  total  bias  velocity 


A V 


B 


(21) 


The  general  statement  of 
Find  an  aimpoint  fx.  in 

probability  constraint 


the  biased  aimpoint  guidance  problem  is  as  follows: 
the  impact  plane  which  satisfies  the  impact 


P0I  A P (22) 

and  minimizes  a performance  functional  having  form 

J = ( jl  - £*)T  A ( £ - £*)  (23) 

"k 

where  fi  is  the  nominal  aimpoint  and  A is  a constant  symmetric  matrix 
that  will  be  defined  subsequently. 


The  solution  of  this  problem  is  detailed  in  the  section  on  biased  aimpoint 
guidance  in  the  analytical  manual.  Only  the  results  will  be  presented  here. 
The  assumption  of  constant  probability  density  over  the  target  planet 
capture  area  permits  us  to  rewrite  constraint  equation  (22)  as 


+ 2A„ 


ix  + A 

1^2  2 


= C 


(24) 


where 


and  [X 


2 

C 


and  SI 


(25) 


The  inequality  has  been  replaced  by  an  equality  since  the  solution  can  be 
shown  to  lie  on  the  constraint  boundary,  which,  from  inspection  of  equation 
(24)  is  an  ellipse  centered  at  the  target  planet. 


If  tj  is  the  time  of  the  final  midcourse  correction,  matrix  A will  be 

chosen  as  a 2x2  identity  matrix.  The  minimization  of  J is  then  equivalent 
to  minimization  of  the  miss  distance  | ||  “ I • If  t.  is  not  the 

r i , , , _ Cjj  ^ 

final  midcourse  correction  time,  A will  be  defined  as  follows: 
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T 

A = ^ 0 (26) 

j+1  j+1 


Here  denotes  the  aimpoint  guidance  matrix  for  the  next  midcourse 

j+1 

correction  occurring  at  time  t . • this  case  the  minimization  of  J 

j+x  I -»  I 

is  equivalent  to  the  minimization  of  | AVRR  ^ j , i.e.,  the  velocity 

required  to  remove  bias  Sfl  _ at  time  t . , . will  by  minimized.  The 

j J ' 

computation  of  0^+1  is  based  on  the  variation  matrix  *7j+1>  Just  as 
was  based  on  T)  ^ 


However,  77  can  be  computed  more  efficiently  by 

j+1 


using  the  relationship 

V 


j+1 


-1 

77  0 

j j+1 » j 


where  0 . , . . 

J+1,3 


is  the  state  transition  matrix  over 


[v  Vi]- 


(27) 


If  we  define 


to 

A = 


a 

^ 3 


2J 


then  the  necessary  condition  for  a minimum  is  given  by 

(aiX3  ■ a3Xl)"l+  (a3X2  ' a2X3>"2  + '“iS  ' °2 X l^l": 


+ <’al  Vi*  - a3X3"2*  + a3Xl"l‘  + a2Xl"2*>  *1  + 


(-a  X U * ~ a X U*  + a X I U * + a X U *)  U ~ 0 (28) 

1 2^1  3 2^2  3 3^1  2 3^2  ^2 


Thus,  our  problem  is  reduced  to  finding  and  fl  which  satisfy 

equations  (24)  and  (28).  Since  the  analytical  solution  of  these  equations 
proved  intractable,  a standard  Newton  iteration  technique  is  employed  in 
BIAIM  which  quickly  converges  to  solutions  for  and  fl  ^ . The  iteration 

process  is  started  with  an  initial  guess  defined  as  the  intersection  of  the 
extended  fj*  vector  and  the  constraint  boundary  defined  by  equation  (24). 

This  initial  guess  is  given  by 
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* 


o 


n 


1 


/ 


\ 


o 


2 


Kgn 


( nr 


c 


/%*' 

2 

+ 2 k 

'O 

— 3F 

+ X 

V?  1 

J 

2 


(29) 


where  c is  defined  by  equation  (25). 

In  addition  to  the  previously  described  iteration  process,  subroutine 
BIAIM  also  employs  an  outer  iteration  loop  which  accounts  for  the  depen-^ 

dence  of  Q.  (equation  (6))  on  . The  execution  error  covariance  Q. 

J j J 

is  a function  of  the  total  velocity  correction  at  t^  , but  the  total 
velocity  correction,  in  particular  AVg  , depends  on  b[4.  . This  coupling 

j J 

is  resolved  by  recomputing  Q,  at  the  end  of  the  previously  described 
biasing  technique  and  repeating  the  biasing  cycle  until  the  error  function 


P0I 


-3 

P x 10 


is  satisfied.  This  outer  iteration  process  is  not  performed,  however,  if 
tj  = injection  time  since  at  injection  equation  (6)  is  replaced  by  the 

equation 


and 

j 


is  always  zero. 


Reference:  Mitchell,  R.  T„ , and  Wong,  S.  K.  : Preliminary  Flight  Path 

Analysis  Orbit  Determination  and  Maneuver  Strategy  Mariner 
Mars  1969.  Project  Document  138,  Jet  Propulsion  Laboratory, 
,1968. 
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Compute  constants  defining  the 
elliptical  constraint  boundary 

associated  with  vl . . 

J 


BIAS-1 


BIAS  Analysis 


The  actual  measurement  Y at  time  t.  is  riven  by 

k.  K 


+ b, 


+ V 


where  _Y^  is  the  ideal  measurement,  which  would  be  made  in  the  absence 
of  instrumentation  errors,  b^  is  the  actual  measurement  bias  and 
represents  the  actual  measurement  noise. 


The  function  of  subroutine  BIAS  is  to  compute  the  measurement  bias  b^ 

for  the  appropriate  measurement  type.  The  constant  biases  for  all  measure- 
ment devices  are  stored  in  the  vector  BIA.  Subroutine  BIAS  selects  the 
appropriate  elements  from  this  vector  to  construct  the  actual  measurement 
bias. 
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BIAS- 2 


BIAS  Flow  Chart 


ENTER 


MC0DE  «=  ? 


10,11,12,13 


1,2, 3, 4, 5, 6,7, 8 


Compute  the  bias  vector 
for  3 star-planet  angle 
measurements . 


MC0DE  even? 


r > 

RETURN 


Compute  the  bias  for 
a range- rate  measure- 
ment from  the  appro- 
priate station. 


Compute  the  bias  vector 
for  a range  and  range- 
rate  measurement  from 
the  appropriate  station. 


11,12,13 


Compute  the  bias  for 
the  appropriate  star 
planet  angle  measure 
ment . 


Compute  the  bias  for 
an  apparent  planet 
diameter  measurement. 


BLKDAT- 1 


BLKDAT  Analysis 


Subroutine  BLKDAT  is  responsible  for  setting  up  constants  used  in 
computing  ephemeris  data  for  the  gravitating  bodies. 

The  arrays  set  up  by  BLKDAT  and  their  definitions  are  as  follows: 


Array 
CN  (80) 

ST (50) 
SMJR(18) 

EMN(15) 
PMASS(ll) 
RMASS(ll) 
RADIUS (11) 
SPHERE(ll) 
MONTH (12) 
PLANET (11) 


Definition 

Constants  defining  mean  elements  for  inner  planets 
Constants  defining  mean  elements  for  outer  planets 
Constants  defining  semi-major  axes  for  planets  and 
moon 

Constants  defining  lunar  elements 

Gravitational  constants  of  sun,  planets,  and  moon 

Mass  of  bodies  relative  to  sun 

Surface  radii  of  sun,  planets,  and  moon 

Sphere  of  influence  radii  of  sun,  planets,  and  moon 

Names  of  months  for  output  purposes 

Names  of  planets  for  output  purposes 


The  definitions  of  the  CN,  ST,  SMJR,  and  EMN  arrays  are  provided  in 
Tables  2 through  5 on  the  following  page.  The  actual  constants  stored 
in  those  arrays  are  the  ephemeris  data  listed  on  the  next  pages  following. 


The  constants  stored  in  the  other  arrays  are  given  below. 


Body 

FMASS  (AU3/day2) 

RMASS* 

RADIUS  (AU) 

SPHERE  (AU) 

Sun 

2 . 959122083 (-4) 

1.0 

4 . 66582 (-3) 

NA 

Mercury 

4 . 850 (-11) 

1.639(-7) 

1 . 617  (-5) 

7.46  (-4) 

Venus 

7. 243  (-10) 

2 .448  (-6) 

4.044(-5) 

4 . 12 (- 3) 

Earth 

8 . 8875  7 (- 10) 

3 . 003  (-  6) 

4 . 263 (-5) 

6.18(-3) 

Mars 

9 . 5497905 (-11) 

3 .236 (-7) 

2 .279  (- 5 ) 

3 . 78  (-3) 

Jupiter 

2 . 8252  (-7) 

9 . 547  (-4) 

4 . 7727  (-4) 

.3216 

Saturn 

8 . 454  (-8) 

2.857  (-4) 

4.0374  (-4) 

.3246 

Uranus 

1 .290  (-8) 

4.359(-5) 

1 .5761  (-4) 

.346 

Neptune 

1 . 5 (-8) 

5.069(-5) 

1 . 4906  (-4) 

.5805 

Pluto 

7 . 4 (- 10) 

2 .501  (-6) 

4 . 679  (-5) 

.2366 

Moon 

1 .0921748  (-11) 

3.696(-8) 

1 . 161  (-5) 

3. 71394(-4) 

* Truncated  from  program  values 
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Constant 


Mercury 

Venus 

Earth 

Mars 

Jupiter 

Saturn 

Uranus 

Neptune 

Pluto 

Moon 

Table  1. 


Constant 


Mercury 

Venus 

Earth 

Mars 

Table  3. 


Cons  tant 


Jupiter 

Saturn 

Uranus 

Neptune 

Pluto 

Table  4. 


Constant 
Moon 
Table  5. 


Array  Definitions 


i 

Q 

u) 

e 

M 

a 

6 J 

E 

ao 

a 

1 

1 

2 

3 

4 

5 

6 

7 

8 

1 

2 

9 

10 

11 

12 

13 

14 

15 

16 

3 

4 

17 

18 

19 

20 

21 

22 

23 

24 

5 

6 

25 

26 

27 

28 

29 

30 

31 

32 

7 

8 

33 

34 

35 

36 

37 

38 

39 

40 

9 

10 

41 

42 

43 

44 

45 

46 

47 

48 

11 

12 

49 

50 

51 

52 

53 

54 

55 

56 

13 

14 

57 

58 

59 

60 

61 

62 

63 

64 

15 

16 

65 

66 

67 

68 

69 

70 

71 

72 

17 

18 

73 

74 

75 

76 

77 

78 

79 

80 

ELMNT  Array  --  Conic  Elements  Table  2.  SMJR  Array 


i0  il  i2  13  ^0  w0  ***1  W2  W3  e0  el  e2  e3  M0  M1  M2  M3 


1 2 3 4 5 6 7 8 9 10  11  12  13  14  15  16  17  18  19  20 
21  22  23  24  25  26  27  28  29  30  31  32  33  34  35  36  37  38  39  40 
41  42  43  44  45  46  47  48  49  50  51  52  53  54  55  56  57  58  59  60 
61  62  63  64  65  66  67  68  69  70  71  72  73  74  75  76  77  78  79  80 

CN  Array  --  Inner  Planet  Constants 
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19 
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21 

22 

23 
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26 

27 

28 

29 
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31 
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ST  Array  — 

Outer  : 

Planet  Constants 

$2  ^3 

t\J 

r*j 

ui 

/V  /V 

W2  W3 

Lo 

L1 

L2 

L3 

i e 

a 

1 2 

3 4 

5 

6 

7 8 

9 

10 

11 

12 

13  14 

15 

EMN  Array  --  Lunar  Constants 
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Planetary  and  Lunar  Ephemerides 


Mean  Elements  of  Mercury 

i = 0.1222233228  + 3.24776685  x 10"5  T - 3.199770295  x 10-7  T2 
& *=  0.8228518595  + 2.068578774  x 10-2  T + 3.034933644  x 10“6  T2 
CO  m 1.3246996178  + 2.714840259  x 10~2  T + 5.143873156  x 10“6  T2 
e = 0.20561421  + 0.00002046  T - 0.000000030  T2 
M - 1.785111955  + 7.142471000  x 10“2  d + 8.72664626  x 10-9  D2 
a - 0.3870986  A.U.  = 57,909,370  km 
Mean  Elements  of  Venus 

i = 0.0592300268  + 1.7555510339  x 10-5  T - 1.696847884  x 10-8  T2 


Q - 1.3226043500  + 

1.570534527  x 

10"  2 

T + 

7.155849933  x 

1 

O 

r- 1 

T2 

W = 2.2717874591  + 

2.457486613  x 

10"2 

T + 

1.704120089  x 

in 

i 

o 

T— < 

T2 

e = 0.00682069  - 0.00004774  T + 0.000000091  T2 
M = 3.710626172  + 2.796244623  x 10-2  d + 1.682497399  x 10“6  D2 
a = 0.7233316  A.U.  = 108,209,322  km 
Mean  Elements  of  Earth 
i = 0 
= 0 

CO  - 1.7666368138  + 3.000526417  x 10“2  T + 7.902463002  x 10“6  T2 
+ 5.817764173  x 10“8  T3 
e - 0.01675104  - 0.00004180  T - 0.000000126  T2 
M = 6.256583781  + 1.720196977  x 10~2  d - 1.954768762  x 10'7  D2 
- 1.22173047  x 10”9  D3 
a - 1.0000003  A.U.  = 149,598,530  km 
Mean  Elements  of  Mars 

i = 0.0322944089  - 1.178097245  x 10_5  T + 2.201054112  x 10" 7 T2 
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S2  = 0 .8514840375  + 1.345634309  x 10"2  T - 2.424068406  x 10“8  T2 
- 9.308422677  x 10-8  T3 

U)  m 5.8332085089  + 3.212729365  x 10"2  T + 2.266503959  x 10"6  T2 
-2.084698829  x 10”8  T3 

e » 0.09331290  + 0.000092064  T - 0.000000077  T2 
M - 5.576840523  + 9.145887726  x 10-3  d + 2.365444735  x 10" 7 D2 
+ 4.363323130  x 10"10  D3 
a = 1.5236915  A.U.  = 227,941,963  km 
Mean  Elements  of  Jupiter 

i = 0.0228410270  - 9.696273622  x 10-5  T 

Q - 1.7355180770  + 1.764479392  x 10"2  T 

tJ  - 0.2218561704  + 2.812302353  x 10"2  T 

e - 0.0483376  + 0.00016302  T 
M - 3.93135411  + 1.450191928  x 10~3  d 
a = 5.202803  A.U.  = 778,331,525  km 
Mean  Element  of  Saturn 

i = 0.0435037861  - 7.757018898  x 10"8  T 
£=  1.9684445802  + 1.523977870  x 10”2  T 
CO  « 1.5897996653  + 3.419861162  x 10"2  T 
e = 0.0558900  - 0.00034705  T 
M - 3.0426210430  + 5.837120844  x 10-4  d 
a = 9 .538843  A.U.  = 1,426,996,160  km 
Mean  Elements  of  Uranus 

i ■=  0.0134865470  + 0.696273622  x 10"6  T 
32  = 1.2826407705  + 8.912087493  x 10"3  T 
3=  2.9502426085  + 2.834608631  x 10"2  T 
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e = 0.0470463  + 0.00027204  T 
M = 1.2843599198  + 2.046548840  x 10-4  d 

a = (19.182281  - 0.00057008  T)  A.U.  = (2,869,640,310  - 85271  T)  km 

Mean  Elements  of  Neptune 

i = 0.0310537707  - 1.599885148  x 10-4  T 

Q = 2.2810642235  + 1.923032859  x 10“2  T 

£>  = 0.7638202701  + 1.532704516  x 10“2  T 

e - 0.00852849  + 0.00007701  T 

M = 0.7204851506  + 1.033089473  x 10-4  d 

a = (30.057053  + 0.001210166  T)  A.U.  = (4,496,490,000  + 181039  T)  km 
Mean  Elements  of  Pluto 

i = 0.2996706970859694 
Q = 1.1914337550102258 
OJ  = 3.909919302791948 
e = 0.2488033053623924 

M « 3.993890007  + 0.6962635708298997  x 10-4 
a = 39.37364135300176  A.U.  = 5,890,213,786,146,730  km 
Mean  Elements  of  Moon 
i - 5.1453964° 

Q = 259.183275°  - 0.0529539222d  + 0.002078  T2  + 0.000002  T3 

to  ■=  334.329556°  + 0.1114040803d  - 0.010325  T2  - 0.000012  T3 

L « 270.434164°  + 13 . 1763965268d  - 0.001133  T2  + 0.0000019  T3 

a = .00256954448  A.U. 

1 

e = 0.054900489 
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Note  1:  The  above  elements  are  referred  to  the  mean  equinox  and  ecliptic 

of  date  except  for  Pluto. 

Note  2:  The  elements  for  pluto  are  oscillating  values  for  epoch  1960 

September  23.0  E.T.  = J.D.  2437200.5 

Note  3:  The  time  interval  from  the  epoch  is  denoted  by  T when  measured 

in  Julian  centuries  of  36,525  ephemeris  days,  by  D = 3.6525  T 
when  measured  in  units  of  10,000  ephemeris  days,  and  by  d = 
10,000D  = 36,525  T when  measured  in  ephemeris  days.  Times  are 
measured  with  respect  to  the  epoch  1900  January  0.5  E.T.  = J.D. 
2415020.0. 


Note  4:  Angular  relations  are  expressed  in  radians  for  planets  and  degrees 

for  moon. 


References:  (1)  Space  Research  Conic  Program,  Phase  III,  J.P.L.,  May  1969 

(Planetary  constants) 

(2)  The  American  Ephemeris  and  Nautical  Almanac  - 1965,  U.S. 
Government  Printing  Office,  Washington,  p.  493  (Lunar 
constants) 
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CAREL  Analysis 


CAREL  converts  the  cartesian  state  (position  and  velocity)  of  a massless 
point  referenced  to  a gravitational  body  to  the  equivalent  conic  elements 
about  that  body. 

Let  the  cartesian  state  be  denoted  r,  v and  let  the  gravitational  con- 
stant of  the  central  body  be  n . 


The  angular  momentum  constant  c is 

c = | r*  x v*  | 

A 

The  unit  normal  W to  the  orbital  plane  is 


A 

w 


r 


x v 
c 


The  semilatus  rectum  p is 


P 


2 

c 

M 


The  semi-major  axis  a is 


a 


(1) 


(2) 


(3) 


(4) 


Thus  a > 0 for  elliptical  motion,  a<  0 for  hyperbolic  motion.  The 
eccentricity  e is 


e 


(5) 


Thus  e < 1 for  elliptical  motion,  e > 1 for  hyperbolic  motion.  The 
inclination  of  the  orbit  i is  computed  from 

cos  i = Wz  (6) 


The  longitude  of  the  ascending  node  is  defined  by 


tan  = 


-W 

y 


(7) 
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The  true  anomaly  f at  the  given  state  is  computed  from 


cos  f = ■£— - — - 

e r 


s in  f = 


cr  o 
Me 


Now  define  an  auxiliary  vector  'z  by 


/N  r -* 

z = — v 

c 


(8) 


(9) 


Then  P , the  unit  vector  to  periapsis,  and  Q , the  in-plane  normal 
to  P , are  defined  by 

P = r cos  f - z sin  f (10) 

Q = r sin  f + z cos  f (11) 

where  r = — . The  argument  of  periapsis  to 
r 

A 

P 

tan  co  = — 

$ 

z 

The  conic  time  from  periapsis  t is  computed  from  different  formulae 
depending  upon  the  sign  of  the  slmi-major  axis.  For  a > 0 (elliptical 
motion) 


is  then  computed  from 


(12) 


t 

P 


(E  - e sin  E) 


COS  E = - e + c.°s  f 
1 + e cos  f 


sin  E 


* 1 - e^  sin  f 
1 + e cos  f 


(13) 


For  a 0 


(hyperbolic  motion)  the  time  from  periapsis  is 


t 

P 


( e sinh  H - H) 


tanh  — 

2 


si 


e - 1 
e + 1 


(14) 


Reference:  Battin,  R.  H. , Astronautical  Guidance,  McGraw-Hill  Book  Co., 

New  York,  1964. 
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CASCAD  Analysis 


CASCAD 


approximates  the  state  transition  matrix  q defining  state 


t , t„ 
o ’ f 


perturbations  over  an  arbitrary  interval 
computing  state  transition  matrices  over  intervals 

• [‘o'  ‘ 


by  recursively 


to>  t ] 


)>  fc2 J 


The  recursive  formula  for  the  k+1  iteration  based  on  the  k-th  iteration 
is  given  by 


0, 


i 1;  <p 

k+1  ,k  k,o 


(1) 


where 


k+. 


,k 


k+1  ,o 

is  the  6tate  transition  matrix  for  the  k+l-st  interval 


[tk’  ^k+l_ 

The  time  interval  4t^+^  = - t^  is  determined  by  the  position  vector 

r,  of  the  spacecraft  relative  to  the  target  planet  along  the  nominal  n-body 
trajectory  at  the  time  t^  . Then  if  R denotes  the  radius  of  the  sphere 
of  influence  of  the  target  planet  the  time  interval  is  defined  by 


+1 


At  , „ 

planet 

if 

rk-  RSOI 

At 

sun 

if 

rk  ^ RSOI 

and  the  n-body  nominal 


trajectory  propagated  over  At 


sun 


does 


At 


SOI 


where  At  . _ and  At 

planet  sun 

a partial  step  may  be  required  so  that 


not  intersect  the  SOI. 

if  1:^  > ^SOI  an<^  n“b°dy  nominal 

trajectory  intersects  the  SOI  after  the 
time  interval  /It^^  where  4t  At 


sun 


are  input  parameters.  For  the  last  interval 


At  - t 
n f 


n- 1 


The  i J/  matrix  may  be  computed  by  either  of  two  models.  In  the  patch 

k+l,k 

conic  model  the  position  and  velocity  vectors  R^,  of  the  spacecraft 


relative  to  the  dominant  body  (the  sun  if  ^t. 


target  planet  if  At 


k+1 


At 


k+1 


At 


sun 


or  AtSQ1,  the 


plane 


. ) at  the  time  t is  used  to  define 
t k 
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conic  with  respect  to  the  dominant  body  and  the  Danby  matrizant  over  the 
given  interval  defines  k (C0NC2)  . 

In  the  virtual  mass  model  the  position  and  velocity  vectors  R^,  are 

computed  relative  to  the  virtual  mass  and  the  gravitational  constant  used 
is  that  of  the  virtual  mass  magnitude  at  the  time  t^.  The  Danby  matrizant 

corresponding  to  this  conic  then  is  used  to  compute  \p  (C0NC2) . 

h*h  1,1c 

The  recursive  process  continues  until  the  state  transition  matrix  over  the 

entire  interval  t . tr  is  determined. 

o f 


Reference:  Danby,  J.M.A.,  "The  Matrizant  of  Keplerian  Motion,"  AIAA 

Journal,  vol  2,  no  1,  January,  1964. 
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CENTER  Analysis 


Let  the  state  vector  of  position  and  velocity  of  the  gravitating  bodies 

(excluding  the  moon)  in  heliocentric  ecliptic  coordinates  be  denoted 

p,  , i j i.  at  some  reference  time.  Let  the  index  of  the  earth  be  i_.  Then 
'l  l & 

the  coordinates  of  all  bodies  (excluding  the  moon)  relative  to  the  earth 

is 


r 

i 


i“l  >n  , i?^ 


v 


i 


i=l,n  , i^i 
’ M 


(1) 


Le  t the 
denoted 


position  and  velocity  of  the  moon  relative  to  the  earth  be 


‘V 


v . 


Define  the  radius  vector  to  the  center  of  mass  (in  earth  ecliptic  coordin- 
ates) by 


E 


i=l 


M = 


- n 


E 


(2) 


Its  velocity  relative  to  the  earth  may  then  be  found  by  differentiation. 


n 

\m  ■ T E A«i  \ (3) 

x»=l 

The  coordinates  of  all  gravitating  bodies  relative  to  the  center  of  mass 
may  then  be  computed 


V 

i 


(4) 
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C0NC2  Analysis 

C0NC2  is  responsible  for  the  computation  of  a state  transition  matrix 
about  a conic  trajectory  using  the  Danby  matrizant  analytic  formula. 

Danby  has  shown  (see  Reference  2)  that  the  state  transition  matrix  (or 
matrizant)  has  a particularly  simple  form  if  written  in  the  orbital  plane 
coordinate  system.  The  state  transition  matrix  0 defined  by 

«Xf  = 0 (tf,  to)  axo  (i) 

where  <5Xf,  6x  refer  to  perturbations  about  a conic  trajectory  at  time 
tf,  tQ  respectively  may  be  written  in  the  orbital  plane  system 

0(tf,  to)  = M(tf)  M"1  (tQ)  (2) 

where  M(t),  M ^(t)  may  be  computed  from  the  following  formulae 


M - X YX-h  0 2X-  3 T X YY  0 

Y -XX  0 2Y-3TY  -YX-2h  0 

0 0 Y 0 0 -X 

X YX+YX  0 -X-3TX  Y2  + YY  0 

Y -X2-XX  0 -Y-3TY  -XY-YX  0 

.0  0 Y 0 0 -X  _ 

- 1 T T 

M = AJM  J 

where  X,Y,X,Y,X,Y  are  evaluated  at  the  time  t 
h is  the  angular  momentum  constant 

T is  the  time  interval  from  t to  some  epoch  (periapsis) 
and  A * diag  ( a/jU,  a//jh,  1/h,  a//j , a/flh,  1/h) 


(3) 

(4) 

(5) 


Thus  to  use  the  Danby  formulation  one  must  determine  the  transformation 
from  the  reference  frame  to  the  orbital  plane  coordinates,  compute  the 
values  of  the  quantities  X,Y,X,Y,X,Y  and  h and  T at  the  times  tQ,  t 

and  then  use  the  above  equations. 

Let  the  initial  state  of  the  conic  be  denoted  r“,  "v,  the  gravitational 
force  fl  , and  the  time  interval  Z^t.  Then  the  unit  vectors  P in  the 
direcjtion^of  periapsis,  W in  the  direction  of  the  angular  momentum  vector, 
and  Q = W x f defining  the  orbital  plane  coordinate  system  may  be  computed 
by  the  following  conic  equations 


140 


C0NC2-2 


h 


r x v 


(7) 


W 


r x v 
h 


(8) 


(9) 

(10) 


a 


2 


r 

2. 

rv  / n 


e = Vl  - P/a 


(ID 

(12) 


cos  f = 


p -.J- 
er 


sin  f = 


r h 

tie 


P 


Q 


= £ v - £ r 

h h 


cos  £ — - sin  f z 
r 


sin  f f-  cos  f z* 

r 


f = 


(13) 

(14) 

(15) 

(16) 
(17) 


The  transformation  matrix  from  the  original  r,  v system  to  the  orbital 
plane  system  may  then  be  written 


T 


P 


A 

w 


(18) 


Let  the  true  anomaly  at  the  pertinent  time  (tQ  or  t^)  be  denoted  f . 


Then  the 

quantities  required  in 

(3)  are 

written 

X 

= r cos  f 

Y = 

r sin 

f 

• 

X 

= r cos  f - rf  sin  f 

Y = 

r sin 

f + rf  cos  f 

(19) 

•• 

X 

= _ ££ 

ii 

:> 

- in. 

3 

r” 

3 

r 

Having  computed  the  state  transition  matrix  <P  corresponding  to  the 
orbital  plane  system  by  equations  (2),  (3),  (4),  it  is  an  easy  task  to 
convert  it  to  the  normal  reference  system 

0 = T 0 TT  (20) 
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References:  Battin,  R.  H.  , As tronautical  Guidance,  McGraw-Hill  Book  Co., 

New  York,  1964. 

Danby,  J.M.A.,  Matrizant  of  Keplerian  Motion,  A1AA  J. , vol.  3, 
no.  4,  April,  1965. 
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C0NC2  Flow  Chart 


e: 


CONVRT-1 


CONVRT  Analysis 


Geocentric  equatorial  position  and  velocity  components  are  related  to  geo- 
centric radius,  declination,  right  ascension,  velocity  magnitude,  flight 
path  angle,  and  azimuth  through  the  following  equations: 

x *=  r cos  0 cos  9 

y = r cos  0 sin  9 

z = r sin  0 

x = v (sin  T cos  0 cos  9 - cos  T sin  a sin  9 - cos  T 
cos  o sin  0 cos  9) 

y «=  v (sin  T cos  0 sin  9 + cos  T sin  a cos  9 - cos  T 
cos  a sin  0 sin  9) 

z = v (sin  T sin  0 + cos  T cos  o cos  0) 

The  definitions  of  pertinent  quantities  are  apparent  in  the  following 
figure . 


144 


COPINS- 1 


COPINS  Analysis: 

COPINS  determines  the  impulsive  correction  and  time  required  to  insert 

from  an  approach  hyperbola  into  a coplanar  elliptical  orbit.  The  approach 

hyperbola  is  specified  by  a plane tocentric  state  r,  ‘v’  at  a decision  time 

t,.  The  desired  elliptical  orbit  is  prescribed  by  input  parameters  a,  e, 
d 

ACO  where  a and  e are  the  semi-major  axis  and  eccentricity  of  the 

desired  ellipse  and  A03  is  the  angle  (measured  counter  clockwise)  from 

the  hyperbolic  periapsis  to  the  periapsis  of  the  desired  orbit.  The 
situation  is  illustrated  in  Figure  1. 


Figure  1.  Approach  Hyperbola  and  Desired  Orbit 

The  planetocentric  ecliptic  state  "r,  "v  at  the  time  of  decision  t^  is 
first  converted  to  Keplerian  elements  (aH,  eH,  iH,  tH<j)  via  sub- 

routine CAREL  where  t^,  is  the  time  from  periapsis  (negative  on  the  approach 

ray).  The  angle  between  the  hyperbolic  periapsis  and  the  approach 

A 

asymptote  S is  computed  from 

COS  f«  = J 0 < f«<  90°  (1) 

Thus  the  angle  (j)  between  the  hyperbolic  periapsis  and  the  desired  elliptical 
periapsis  is  given  by 

U «=  A 6J  (2) 


The  hyperbola  and  ellipse  may  therefore  be  described  in  the  PQ  plane  by 
standard  conic  formula,  specifically, 
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r = H 

H 1 + e cos© 
H 


E 1 + e cos  (0  - id) 


(3) 


A 

where  0 Is  measured  counter-clockwise  from  P and  p ,p  are  the  semi- 

il  hi 

latus  rectum  of  the  hyperbola  and  ellipse  respectively.  Obviously  if  an 
angle  of  intersection  0*  is  known,  the  states  on  both  conics  ( "r  f,  v^  ) 

and  ( "r**,  v**)  may  be  computed  from  conic  formulae  and  the  desired  impul- 

sive  correction  is  given  by 


Av 


(4) 


Likewise  the  time  from  periapsis  to  the  intersection  point  t may  be 
computed  using  hyperbolic  formula  and  therefore  the  time  from  decision  to 
execution  is  given  by 


At  = trf  - td  (5) 

Thus  the  coplanar  insertion  problem  reduces  to  the  determination  of  the 
optimal  angle  0 for  the  impulsive  maneuver. 

From  (3)  the  values  of  0 for  which  r = r are  given  by 

HE 

cos  e - (6) 

+ z 


where 


y “ PH  eE  COSW  - eH 
Z “ Pr  eE  s in(J 

D = y2  + z2  - x2 


(7) 


If  the  discriminant.  D 0 there  are  at  most  two  real  non- extraneous 
solutions  8UC^  that  rg(0)  = r^(9).  Note  that  the  angle  0 may 

not  lfe  in  the  region  inside  the  approach  and  departure  asymptotes.  If 
there  are  two  solutions,  both  Av  ' s are  computed  by  (4)  and  the  minimum 
Av  transfer  is  selected. 
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If  D<0,  the  applied  hyperbola  and  the  desired  orbit  do  not  intersect  and 
there  is  no  impulsive  transfer  between  the  two  conics.  In  such  a case  the 
desired  elements  a^  and  Cg  are  modified  to  determine  the  "best"  tangen- 
tial solution  possible.  Three  different  modifications  are  tested: 


(1)  Vary  r while 

a 

(2)  Vary  Tp  while 

(3)  Vary  a^  while 

The  three  modification  schemes 
nonintersecting  orbit  is  shown 


holding  r at  the  desired  value. 

P 

holding  r&  at  the  desired  value, 
holding  eg  at  the  desired  value. 

are  illustrated  in  Figure  2 where  the  original 
by  the  broken  lines. 


a.  Modify  r 

' ' a 


b.  Modify  r 

P 


c.  Modify  a 


Figure  2.  Candidate  Orbit  Modifications 


It  is  desired  to  modify  the  "a"  and  the  "e"  of  the  desired  orbit  to  achieve 
the  tangential  configurations.  From  (6)  it  is  obvious  that  a necessary 
condition  for  a tangential  solution  is  given  by  D=0.  Using  (7)  D may  be 
written 

D ' PH  (*E  ‘ l)  + PE  b + 2*uh  - CVe 

where  b «=  e2  - 1 

H 

C = 2pH®H  COS  W (8) 

where  it  is  observed  the  approach  hyperbola  is  fixed  and  it  is  desired  not 
to  vary  the  (J  of  the  desired  ellipse  so  that  subsequent  apsidal  rotations 
are  avoided. 
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Modification  Option  1:  Rewriting  (8a)  in  terms  of  a and  r leads  to 


a2D 


<4  rp  *>  + 4 rp  PH  - 2 rp  “2 

+ (-2  p2  r - 4 r"^  b - 2 p r2  + 3 r2  b)a 
H p p H p p 

. , 2 2 . 4 3 N 

+ (p„  r + r b-cr  ) 
p p p 


(9) 


Now  if  D is  set  equal  to  0,  r held  at  its  desired  value,  and  the  resulting 

quadratic  solved  for  "a",  the  solution  will  correspond  to  the  tangential 
solution  which  holds  r constant.  If  a£:0  or  imaginary,  the  solution 

is  disregarded.  The  modified  eccentricity  is  of  course  defined  by 


1 - l£ 

a 


(10) 


Modification  Option  2:  Rewriting  (8a)  in  terms  of  a and  r^  leads  to 

a2D  *=  (4  r2  b + 4 r p + 2 r c)a2 

a.  a.  ii  a 

+ (-2  p2  r - 4 r^  b - 2 pH  r2  - 3 r2  c)a 

+ (PH  rl  + ra  b + c ra  } (11) 


For  computational  purposes  the  similarity  between  (9)  and  (11)  may  be 
exploited.  Again  setting  D = 0 and  holding  ra  at  its  desired  value, 

the  value  of  "a"  may  be  determined  which  specifies  the  tangential  solution 
holding  ra  constant.  Having  determined  a realistic  value  of  "a",  the 

corresponding  eccentricity  is  given  by 


a 


(12) 


Modification  Option  3:  Rewriting  (8a)  in  terms  of  a 

D = (d2b)a2  + (2pHd  - cd  e£)a  - dp2 

d = (1  - e2  ) 

E 


and  e leads  to 
E 


(13) 


Setting  D = 0 and  solving  for  "a"  while  holding  e at  its  desired  value 

£ 

then  defines  the  option  3 solution. 
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To  determine  the  "best"  modified  orbit  from  the  three  candidatet  options 
a rather  arbitrary  scheme  is  used.  A scalar  error  is  assigned  to  each 
option  according  to  a weighting  factor  and  the  difference  between  the 
desired  and  achieved  values  of  the  periapsis  and  apoapsis  radii: 


where  the  scalar  factor  is  set  to  1,2,3  respectively  for  the  three 

options.  Thus  the  preferred  strategy  is  the  one  which  requires  a correction 
only  at  apoapsis  while  the  least  desired  scheme  requires  subsequent  corrections 
both  at  periapsis  and  apoapsis. 

Having  determined  orbital  elements  that  necessarily  lead  to  a tangential 
solution,  (6)  may  now  be  used  to  compute  the  angle  of  intersection  9 . 
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Determine  radium  at  intersection  on 
hyperbola  r(  and  ellipse  rg  . 
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r,  - r 
h e 


e = ?>  < B 


Compute  state  rn,  and  time 

tn  on  hyperbola  and  state  on 
ellipse  ~r  , v'e  at  intersection. 


0 = -0 


Compute  insertion  velocity  and  time 
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DESENT  Analysis 


DESENT  computes  a correction  to  an  initial  velocity  by  the  steepest 
descent  or  conjugate  gradient  techniques  for  use  by  TARGET. 

The  technique  used  is  determined  by  the  value  of  METHOD.  DESENT  takes  n 
steps  in  the  conjugate  gradient  directions  before  rectifying  by  making  a 
steepest  descent  step  where  n = METHOD  - 1 . Thus  if  METHOD  = 1,  all 
steps  are  taken  in  the  steepest  descent  direction. 


Let  the  current  iterate  initial  state  be  denoted  r,  v . Let  the  scalar 
error  of  the  auxiliary  parameters  corresponding  to  this  state  be  denoted  < 
Let  the  perturbation  size  for  the  sensitivities  be  dv  . 


The  current  gradient  g^  is  computed  by  numerical  differencing.  For  the 

k-th  component  of  g the  corresponding  component  of  velocity  is  perturbed 

c 

by  dv 


v 

P 


v + dv 


(1) 


The  initial  state  ( r,  v^  ) is  then  propagated  to  the  final  stopping 
conditions.  Let  the  auxiliary  parameters  of  that  trajectory  be  denoted  £ 
The  error  associated  with  the  perturbed  state  is  then 


P = W • ( a*  - a * ) 
P P 


(2) 


where  W represents  the  weighting  factors  and  a are  the  desired  target 
conditions.  The  k-th  component  of  the  current  gradient  is  then 


(3) 


The  corrected  gradient  is  given  by 


steepest  descent  step 


P 

P 


conjugate  gradient  step  (4) 


where  the  subscript  c refers  to  a current  parameter,  p refers  to  a 
previous- step  parameter. 
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The  unit  vector  in  the  direction  of  the  next  step  is  then  given  by 

— k 

p 

q - - -£■  (5) 

C Pc 

The  directional  derivative  of  the  scalar  error  in  the  the  direction  is 

d = g • q (6) 

c c 

The  nominal  step  size  h is  computed  from  a linear  approximation  to  null 
the  error 


h = 


£ 

-d 


(7) 


The  initial  state  corrected  by  this  nominal  correction  is  then  propagated 
to  the  final  stopping  conditions  and  the  resulting  error  £ computed. 

The  three  conditions 

y (o)  = £ 

y (h)  = € 

y ' (o)  = d (8) 

may  now  be  applied  to  the  formula  of  a parabola  y - £ = a (x  - hw)  to 

predict  the  optimal  step  size  h yielding  the  minimum  error  £ * 


dh2 


2 (dh  4-  £ - £ ) 


(9) 


The  correction  for  the  current  is  then  given  by 

Av  = h*  q 

g 


(10) 


Reference:  Myers,  G.  E.,  "Properties  of  the  Conjugate  Gradient  and  Davidon 

Methods",  AAS  Paper  68-081.  Presented  at  1968  AAS/AIAA  Astro- 
dynamics  Specialist  Conference,  Jackson,  Wyoming. 
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Pc  = Sc 


Does  IT  = 1 or 
IT  = 0 (mod  KREK)? 


RETURN 
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DIMPCP  Analysis 

Subroutine  DIMPCP  converts  the  actual  probe  target  parameters  of 
declination  6 and  right  ascension  a of  the  trajectory  impact  point 
on  the  planet  into  the  auxiliary  target  parameters  of  equivalent 
B*T  and  B”R.  To  do  so  it  assumes  the  direction  of  the  hyperbolic 
excess  velocity  and  the  energy  of  the  trajectory  are  known  so  the 
S^,  TT,  and  R*  in  the  ecliptic  frame  and  the  semimajor  axis,  a,  of 
the  approach  hyperbola  are  available  as  inputs.  To  complete  the 
specification  of  the  probe  impact  point,  the  subroutine  also  re- 
quires the  radius,  r,  of  the  planet  at  impact  as  well  as  the  trans- 
formation, L,  from  the  inertial  ecliptic  frame  to  the  coordinate 
system  to  which  the  right  ascension  and  delcination  are  referenced. 

Derivation  of  the  necessary  equations  is  relatively  straightforward 
once  the  appropriate  variables  are  defined.  Let  £ be  a planet- 
centered  unit  vector  in  the  direction  of  the  impact  point.  Then, 
in  the  inertial  ecliptic  system, 


P 


(1) 


Define  to  be  the  unique  angle  on  the  closed  interval  from  0 to  it 
between  £ and  S_  (see  Fig.  1).  Finally  denote  the  true  anomalies 
of  £ and  S_  by  0 and  0 , respectively. 

J 

First  DIMPCP  determines  whether  the  desired  impact  point  is  indeed 
targetable.  It  is  apparent  from  Figure  1 that 

|e|  = <f>  - eg  (2) 

It  is  further  obvious  from  the  figure  that  the  approach  hyperbola 
will  intersect  the  planet  surface  at  true  anomalies  of  both  +0 
and  -0.  Obviously  only  the  negative  true  anomaly  impact  points  are 
physically  realizable  since  the  trajectory  stops  at  the  first  inter- 
section with  the  planet.  Hence  DIMPCP  requires  the 

Bs  < <P  . (3) 


For  definitions  of  these  vectors  see  the  analysis  section  of 
the  subroutine  STIMP. 
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In  other  words,  there  is  a circular  region  on  the  planet  surface 
of  radius  0 about  the  outgoing  pierce  point  of  the  £ vector  inside 

of  which  no  probes  can  be  targeted.  If  p falls  in  this  untarget- 
able  region,  DIMPCP  repositions  the  desired  impact  point  direction 
to  p_'  , the  nearest  acceptable  direction  in  the  plane  determined 
by  J3  and  p_.  Analytically  this  is  done  by  expressing  jo'  as  a linear 
combination  of  p_  and  Sj  that  is 

p ' = dx  £ + d2  S . (4) 


Then  the  constraints 


and 


IjP'il  - 1 


(5) 


£_  0 £*  = COS  (0  - <J>) 

O 


(6) 
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are  applied.  These  result  in  the  following  pair  of  simultaneous 
equations  for  and  d^ : 

1 = dj'  + 2 d^  d2  cos  <p  + d2  (7) 

cos  ( 9g  — 4>)  = ^ + d2  cos  ^ (B) 

Solving  (8)  for  d^  in  terms  to  d2  and  substituting  Into  (7)  pro- 
duces the  quadratic 


1 - cos2  (0g  -<())=  d|  (1  - cos2  <p)  . (9) 


Assuming  cos  41  #1  leads  then  to  the  conclusion  that 


1 - cos2  (0  - 4) 


d2  = ± 


(10) 


1 - cos'*  <j> 


Figure  2 geometrically  interprets  the  two  roots  of  equation  (9) 
given  by  (10). 


Figure  2 Geometrical  Interpretation  of  the  Two  d2~Roots 
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Clearly  the  d£  value  corresponding  to  the  positive  radical  is  ex- 
traneous since  it  produces  a p_'  nearer  .S  than  p_.  Hence 


d 


2 


- cos2  (6g  - <t>) 

1 - COS2  0 


d = cos  (0  - <J>)  + cos  <j> 

1 


1 - cos2  (0g  - tp) 

1 - COS2  <j> 


(11) 


(12) 


The  exceptional  case  that  cos  <j>  = -1  cannot  occur  since  then  <p  = ti 
and  hence  8^  < <f>.  However,  cos  can  equal  1.  In  this  case  p_ 

and  S_  are  coincident  so  p_'  cannot  be  taken  as  a linear  combination 
of  the  two.  Further,  no  particular  point  on  the  boundary  of  the 
circular  untargetable  region  recommends  itself.  Hence  DIMPCP  ar- 
bitrarily puts  _p_'  in  the  S-T  plane  as 


p_*  = S_  cos  0S  + T sin  eg  . (13) 

On  repositioning  £,  DIMPCP  prints  out  the  right  ascention  a'  and 
declination  6 ' of  jo ' making  use  of  the  formulae 


a'  = tan  1 (p^/pp 


(14) 


6'  = sin-1  (Pg) 


(15) 


Having  repositioned  p_,  if  necessary,  DIMPCP  calculates  the  magni- 
tude of  the  desired  B^.  It  can  readily  be  shown  that 


cos  es 


1 

e 


(16) 


sin  es 


(17) 


B a - 1 


(18) 
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Recall  the  polar  equation  of  the  near-planet  conic  trajectory,  namely 


r = 


a(l  - e2) 
1 + e cos  0 


(19) 


Substituting  equation  (2)  into  (19)  and  rearranging  gives 


a(l  - e2)  = r [1  + e (cos  <j>  cos  0 + sin  <j>  sin  0 ] . (20) 

O D 


Using  equations  (16)  and  (17)  in  (2)  yields 


a(l  — e2)  = r (1  + cos  tf>  + Ve2  — 1 sin  40 


. (21) 


Eliminating  the  eccentricity  from  equation  (19)  by  means  of  (18) 
produces  a quadratic  in  B,  that  is. 


-B2/a  = r (1  + cos  40  -rB/a 


(22) 


Applying  the  quadratic  formula  to  (20)  gives 


[r  sin  4>  - Vr2  sin2  4>  - 4 ar  (1  + cos  4>)  ] 


(23) 


Since  1 + cos  <43  > 0 for  all  4>  and  a < 0 for  hyperbolic  approach 
trajectories,  the  root  corresponding  to  the  negative  radical  in 
(21)  produces  a negative  magnitude  of  B^  and  hence  must  be  extrane- 
ous . Thus 


„ [r  sin  4>  + Vr2  sin 
B " 2 


dJ.  V,  . 


One  can  further  conclude  from  the  radicand  of  (23)  that  a solution 
for  B will  exist  if,  and  only  if, 

4 ar  (1  + cos  0)  < r2  (1  - cos2  4>)  , (25) 


or  equivalently  if  cos  4>  f ~ 1 


cos 


d < l — 


4a 


(26) 
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Since  a is  negative  for  a hyperbolic  approach,  this  last  inequalit— 
is  always  true.  Further  if  cos  4>  =»  -1,  B = 0.  Hence  equation  (22) 
always  has  the  unique  nonnegative  solution  given  by  (24) . 

Next  DIMPCP  computes  the  direction  of  B^.  Since  the  desired  B^  must 
lie  in  the  plane  determined  by  S_  and  £,  there  must  exist  real  num- 
bers C ^ and  C2  so  that 


B/B  = + C2  £ . (27) 

Applying  the  constraints  that  | | B_/B  | | = 1 and  B/S^  = 0 
respectively 


Cj  + 2 Cx  C2  cos  4 + = 1 


(28) 


C-^  + C2  cos  <j>  = 0 


(29) 


Solving  these  two  equations  simultaneously  for  a and  b gives 

C2  = ± 1/sin  <p  (30) 

C^  = + cot  <j>  . (31) 

The  negative  C2  root  and  the  corresponding  positive  root  are  ex- 
traneous since  they  place  ]}  on  the  side  of  S^  opposite  to  £ as  shown 
in  Figure  1.  Substituting  the  correct  pair  of  roots  from  (30)  and 
(31)  into  (27)  gives  the  direction  of  the  desired  B^  as 


B/B  = (£  - S_  cos  i{))/sin  <j>  . (32) 

Clearly  in  the  exceptional  cas&  that  sin  <p  = 0,  the  trajectory 
passes  through  the  center  of  the  planet  coinciding  with  its  asymptote 
so  that  £ = (h 

Finally  DIMPCP  calculates  the  desired  B"T  and  B*R  coordinates  now 
that  B is  known? 


B°T  » B1  T + B2  T2  (33) 

B°R  o B1  Rx  + B2  R2  + B3  R3  . (34) 
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DYN0  Analysis 

Subroutine  DYN0  evaluates  the  assumed  dynamic  covariance  matrix  Q 
over  the  time  interval  t = t - t^  if  IC0DE  =0.  If  IC0DE  = 1 

the  actual  dynamic  noise  covariance  matrix  Q'  is  evaluated  over  the 
same  interval.  In  either  case  the  dynamic  noise  covariance  matrix 
is  assumed  to  have  the  form 

Q = diag  (%  Ki  At4,  % K2  At4,  % K3  At4,  K:  At2,  K2  At2,  K3  At2) 

where  dynamic  noise  constants  , K2,  and  K3  have  units  of  km2/s4. 
To  compute  the  actual  dynamic  noise  covariance  matrix  Q',  we  simply 
replace  K1 , K2 , and  K3  with  the  actual  dynamic  noise  constants 
K{,  K2,  and  K3 , respectively. 
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DYN0S  Analysis 


subroutine  DYN0S  performs  two  functions.  It's  first  function  is 
identical  to  that  of  subroutine  DYN0,  namely,  to  evaluate  the  dynamic 
noise  covariance  matrix  Q over  the  time  interval  At  = t^  - t^  • 

The  second  function  of  subroutine  DYN0S  is  to  comnute  the  actual 
dynamic  noise  which  represents  the  integrated  effect  of 

unmodelled  accelerations  acting  on  the  spacecraft  over  the  time 
interval  Z^t.  Actual  dynamic  noise  uj  u8er^  elsewhere  in  the 

program  to  comDute  the  actual  state  deviations  of  the  spacecraft 
from  the  most  recent  nominal  trajectory. 


If  we  define 


T V 

, where 


(J 


and  oj 


denote  the  contributions  of  unmodelled 


k+1 


k+1 


accelerations  to  spacecraft  nosition  and  velocity,  respectively,  and 
if  we  assume  constant  unmodelled  acceleration  a,  then 


u) . 


k+1 


a (t.  . - t,  ) + cj  (t.  , 

— k+1  k v.  k+1 

2 k 


t ) + cj 

k r, 


CJ, 


k+1 


a (tk,i  - V 


+ CJ 


where  t is  the 
o 


The  program  permits  the  entire  trajectory  to  be  divided  into  three 
arbitrary  consecutive  intervals,  over  each  of  which  a different  con- 
stant unmodelled  acceleration  a can  be  specified.  These  intervals  are 
represented  by  (t  , t^) , (t  , t^)  , and  (t_,,  t^ 

initial  trajectory  time  and  t_  is  the  final  trajectory  time.  If  t, 

I ifi 

and  t^+^  occur  in  different  intervals,  then  the  above  equations  must 
be  evaluated  piece-wise  over  ( t^,  t^+^  ) . 
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DYN0S  Flow  Chart 


DYNOS-2 
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EIGHY-1 


EIGHY  Flow  Chart 
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ELCAR- 1 


ELCAR  Analysis 


ELCAR  transforms  the  standard  conic  elements  of  a massless  point  referenced 
to  a gravitational  body  to  cartesian  position  and  velocity  components  with 
respect  to  that  body. 

Let  the  gravitational  constant  of  the  body  be  denoted  M and  the  given 
conic  elements  (a,  e,  i , D , Q , f ).  The  semilatus  rectum  p is 


p = a (1  - e ) 

Then  the  magnitude  of  the  radius  vector  is  given  by 

P 


r = 


1 + e cos  f 


The  unit  vector  in  the  direction  of  the  position  vector  is 

u = cos  ( w + f)  cos  A - cos  i sin  ( w + f)  sin  £2 
x 

u - cos  ( w + f)  sin  + cos  i sin  ( w + f)  cos  Q 

y 

u = sin  ( w + f ) sin  i 
z 

The  position  vector  r is  therefore 

— 1 /\ 

r = r u 

The  velocity  vector  v is  given  by 

v = / — I (e  + cos  f)(-sin  w cos -cos  i sin  cos  w ) 

x V P l 

-sin  f (cos  u>  cos  (2  -cos  i sin  (2  sin  w )J 

vy  = \j^ £(e  + cos  w sin  S2  +cos  i cos  U cos  w ) 

-sin  f (cos  o)  sin  12  +cos  i cos  Q sin  w 

vz  = \J ~~~  j^e  + cos  ^ sin  cos  w "s:*-n  f sin  i sin 


(1) 


(2) 


(3) 


(4) 


(5) 


The  conic  time  from  periapsis  t is  computed  from  different  formulae 
depending  upon  the  sign  of  the  slmi-major  axis.  For  a 0 (elliptical 
motion) 


(E  - e sin  E) 


ELCAR-2 


cos  E = 


e + cos  f 


sin  E = 


_ 


sin  f 


1 + e cos  f 1 + e cos  f 

or  a 0 (hyperbolic  motion)  the  time  from  periapsis  is 


t 

P 


s inh  H 


H) 


tanh  - 

2 


l 

1 


tan 


f 

2 


(6) 


(7) 
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EPHEM  Analysis 


EPHEM  first  determines  the  current  value  for  the  mean  anomaly  of  the 
pertinent  body.  The  mean  anomaly  M is  computed  from 


M = Mq  + M]_t  + M2t2  + M2t3 
M = M + M-,  t 

0 2 3 r\J 

M = Lq  + Ljt  + L2tz  + L3tJ  - Uf(t) 


for  inner  planets 
for  outer  planets 
for  the  moon 


Kepler's  equation  M = E - e sin  E is  then  solved  iteratively  to  determine 
the  eccentric  anomaly  E . The  subsequent  computations  are  basic  conic 
manipulations : 

p = a(l  - e2) 


r = a(l  - e cos  E) 


Ju\ 

f 2 

l\ 

1 — — — j 

V 

lr 

ai 

cos  f *=  -2—^ — £ 

e r 


cos  y 


rv 


r\J 

OJ  = U)  - Q 


sin  f = 
sin  y = 


"Vl  - cos2  f 
"Vl  - cos2 


sgn(sin  E) 
sgn(sin  E) 


The  cartesian  position  and  velocity  relative  to  the  reference  body  are  then 


r = ri  + rj  + rk 
x y J z 


r = r cos(u+  f)  cos  Q - r sin(w+  f)  sin  Q cos  i 
X 

ry  = r cos(CJ+  f)  sini?  + r sin(6d-f  f)  cos  1/  cos  i 


r «=  r sin(tt>+  f)  sin  i 


r* 

= |_(w  x "r"  ) cos  7 +~r  sin  y 


where  w = (sin  i sin  Q ) i - (sin  i cos  Q ) j + (cos  i)  k 
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When  option  1 is  used,  the  reference  body  for  all  the  planets  is 
the  sun  while  the  reference  body  for  the  moon  is  the  earth. 

When  option  2 is  used  with  heliocentric  inertial  coordinates,  the 
cartesian  state  of  the  earth  is  added  to  the  cartesian  state  of  the 
moon  to  convert  the  state  of  the  moon  to  heliocentric  coordinates 
before  storing  that  state  in  the  F-array. 

When  option  2 is  used  with  barycentric  inertial  coordinates,  sub- 
routine CENTER  is  called  to  convert  all  elements  to  barycentric 
coordinates  before  storing  in  the  F-array. 
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ERRANN  Analysis 


Subroutine  ERRANN  controls  the  computational  flow  through  the  basic 
cycle  (measurement  processing)  and  all  events  in  the  error  analysis/ 
generalized  covariance  analysis  program. 


In  the  basic  cycle  the  first  task  of  ERRANN  is  to_control  the  gen- 
eration of  the  targeted  nominal  spacecraft  state  at  time 

tk+1’  8^ven  state  at  time  t^.  Then  calling  PSIM,  DYN0, 


TRAKM,  and  MEN0,  successively,  ERRANN  controls  the  computation  of 
all  matrix  information  required  by  subroutine  GNAVM  to  compute  the 
actual  and  assumed  knowledge  covariance  matrix  partitions  at  time 


immediately  following  the  measurement. 


At  an  event,  ERRANN  simply  calls  the  proper  event  subroutine  or 
overlay  where  all  required  computations  are  performed.  Subroutine 
ERRANN  also  controls  miniprobe  targeting  in  the  error  analysis 
program. 
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ERRANN-2 


ERRANN-3 


Call  MEN!?)  to  compute  assumed  R, 


Call  GNAVM  to  compute  assumed  covariance 

*•*  *{“ 

matrix  partitions  at  t^+1  and  tk+1 


Increment  print  counter  IPRN 


Is  it  time  to  print? 


Cali  PRINT3  to  write  out  all 
assumed  basic  cycle  data 


Call  DYN0  to  compute  actual  k 


Call  MEN0  to  compute  actual 


Call  GNAVM  to  compute  actual 
2nd-moment  matrix  partitions 

at  Ci  and  Ci 


Call  MEAN  to  compute  actual 
estimation  error  means  at 

Ci and  Ci 
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ERRANN-4 


ERRANN-5 


Define  event  code  IC0DE  and  time  t. 


IC0DE  f 5 or  6? 


Call  SETEVN  to  compute  information 
common  to  most  types  of  events 


Call  prediction 
event  overlay 


Write  quasi-linear  filter- 
ing event  (5)  or  adaptive 
filtering  event  (6)  not 
available  in  ERRAN. 


IUTC  = 1? 


Main  probe  or  miniprobe? 


Propagate  targeted  nominal  to 
probe  sphere.  Write  out  probe 
sphere  conditions 


Call  TPRTRG  to  perform 
mini  probe  targeting 


Define  mini  probe  target  controls 


Call  PR0BE  to  execute  probe 
release  event 


ESTMT-1 


ESTMT  Analysis 


The  initial  values  of  the  state  variables  are  first  set  equal  to  the 
values  at  the  end  of  the  previous  interval.  The  nominal  time  interval 
to  be  used  during  the  current  step  is  computed  from 


c 


2 


(1) 


where  c^  is  the  constant  input  true  anomaly  increment  relative  to  the 
virtual  mass  trajectory. 


The  time  interval  to  the  final  time  t 
is  computed  and  the  current  time  interval 


or  to  the  next  time  printout  t 

P 

/\  t is  adjusted  if  necessary. 


Finally  the  virtual  mass  final  position  and  magnitude  are  estimated  by 
the  expansions 


4V  At 

B 


V 

E 


r + 
V 

B 


B 


+ 


V 

■ av 


A 


2 

t 


(2) 
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ESTMT  Flow  Chart 


ESTMT-2 


ENTER 


\ 

Update  state  variables 
for  next  step. 

\ 

' 

First  interval? 


Is  printout  to  occur 
after  this  increment? 


K0UNT=1 


ITRAT=1 


Calculate  nominal 

value  of  ^t,  . 

k 


t_ 

t_  + A t ^ t 


Atk  ■ £P  - eb 
CE  " CP 

'■>  ” CD  + At 


£e'  £-+At 


At  = t - t 
^ k f B 

t = t 
E f 

KOUNT  = 1 


Estimate  final  magnitude  M 

VE 

and  position  r of  virtual  mass. 
E 


RETURN 


EXCUTE- 1 


EXCUTE  Analysis 


EXCUTE  is  the  executive  subroutine  controlling  the  actual  execution  of 
the  velocity  increment  Av.  The  Av  is  computed  by  TARGET  or  INSERS  or 
read  in  by  the  user. 

Before  executing  the  correction  EXCUTE  computes  peripheral  information 
of  interest  to  the  user.  It  first  determines  the  dominant  body  acting 
on  the  spacecraft.  If  the  spacecraft  is  in  the  moon's  SOI  (with  respect 
to  the  earth),  the  moon  is  the  dominant  body.  If  not  in  the  moon's  SOI 
but  in  any  of  the  planets'  SOI  (with  respect  to  the  sun)  that  planet  is 
the  dominant  body.  Otherwise  the  sun  is  the  dominant  body. 

Having  determined  the  dominant  body  EXCUTE  computes  the  state  of  the  space- 
craft relative  to  that  body.  It  then  computes  the  conic  elements  of  the 
trajectory  both  before  and  after  an  impulsive  addition  of  the  Av  in 
ecliptic  coordinates. 

If  the  dominant  body  is  not  the  sun,  it  makes  the  same  computations  in 
equatorial  coordinates. 

EXCUTE  then  operates  on  the  current  value  MODEL  of  the  array  MDL.  If 
MODEL  = 1,  the  impulsive  model  of  execution  is  commanded.  The  Av  is 
therefore  added  to  the  current  inertial  ecliptic  velocity  before  returning 
to  GIDANS. 

If  MODEL  = 2,  the  pulsing  arc  model  of  execution  is  required.  PREPUL  is 
called  to  perform  the  preliminary  work  needed  for  the  pulsing  arc.  PULSEX 
then  actually  propagates  the  trajectory  through  the  series  of  pulses.  At 
the  completion  of  the  arc  EXCUTE  updates  the  time  and  inertial  ecliptic 
state  (both  position  and  velocity)  of  the  nominal  trajectory  to  the  state 
determined  by  PULSEX. 
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EXCUTE  Flow  Chart 


EXCUTS- 1 


EXCUTS  Flow  Chart 


FLITE- 1 


FLITE  Analysis 


FLITE  solves  the  time  of  flight  equation  (Lambert's  theorem)  using  Battin's 
universal  equation  formulation.  Stated  functionally  Lambert's  theorem 
states  that  the  time  of  flight  tf  is  a function 

t = tf  (ri  + r2>  c,  a)  (1) 

solely  of  the  sum  r^  + r^  of  the  distances  of  the  initial  and  final  points 

of  the  trajectory  from  the  central  body,  the  length  c of  the  chord  joining 

these  points,  and  the  length  of  the  semimajor  axis  a of  the  trajectory. 
Usually  the  time  of  flight  is  known  and  it  is  desired  to  solve  for  the  semi- 
major axis.  The  standard  formulation  involves  different  equations  for  the 
elliptic,  parabolic,  and  hyperbolic  cases,  all  of  which  then  iterate  on  a 
to  determine  the  solution. 

In  Battin's  approach  the  semimajor  axis  a is  replaced  by  a new  variable  x . 
By  further  introducing  two  new  transcendental  functions  S (x)  and  C(x), 
the  special  cases  of  the  flight- time  equation  are  combined  into  one  single, 
better  behaved  formula.  The  functions  S(x)  and  C(x)  are  defined  by 

„ , \ \Tx  - sin  \Tx  „ , , 

S(x)  = C (x) 

x 

sinh  \/-x  - \/-x 

’ . \^3 

= 1 
6 

A parameter  Q is  introduced  as 

Q = — 

s 

2 2 l 

where  c = (r  + r - 2r  r cos  0 ) 2 

12  12 

S = 2 (r!  + r2  + C)  <3) 

The  universal  flight- time  formula  is 


1 - cos  \f~x 

x 

cosh  ^ - 1 

-X 

1 

2 


x > 0 

x < 0 

x = 0 (2) 
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T = 


S (x) 

C3/2(x) 


+ Q 


3/2  S(y) 
3/2 

c ' (y) 


yC  (y)  = Q X C (x) 


(4) 


where  T 


The  choice  of  the  upper  or  lower  sign  is 


made  according  to  whether  the  transfer  angle  0 is  less  or  greater  than 
180°  respectively. 


The  development  of  equations  (4)  is  too  long  and  complex  to  be  given  here. 
It  may  be  obtained  from  the  first  reference  listed  below.  The  following 
steps  of  that  reference  are  noted: 

(1)  the  two  body  problem  on  pp.  15,16 

(2)  the  "vis  viva"  equation  and  Kepler's  equation  on  pp.  50,51 

(3)  Lambert's  theorem  proved  from  Kepler's  equation  on  p.  71 

(4)  the  basic  flight-time  formula  and  detailed  analysis  on  pp.  72-78 

(5)  The  universal  formulation  on  pp.  80,81. 

Instead  of  using  the  equations  (4)  the  authors  of  refence  2 (listed  below) 
determined  y as  a function  of  x as 


x > 0 


x < 0 


(5) 


Therefor.^-  a single  variable  iteration  is  possible.  Newton's  method  is  used 
to  solve5  (4a)  given  T and  Q as 


T(x  ) - T 

x = x - (6) 

T ' (x  ) 
n 


where 


T(x)  = 


s00 

c3/2W 


+ Q 


3/2 


s,(y.), 

c3/2w 


T ' (x)  = 


r-  3/2  , » 

l + k[+Q  - 1 . 5 Y2-yC  (y)  T(x) 

2x  V C(x) 


(7) 


(8) 
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, 2 „ I 2-xC(x) 

k = -sgn  ( 7T  - x)  ^ 2-yC(y)  > (9) 

As  | 2- yC (y ) | — ► 0 , k — >1  . Therefore  if  | 2- yC  (y)  | < 10  ^ k is  set 
to  1.  Also  T'(x)  breaks  down  as  x — ► 0 . Therefore  the  approximation 
is  used: 

_ 3/2 

T ' (x)  = -L-  + 3-  ? |x|  < 10"b  (10) 

2tt 

The  starting  value  for  x is  given  by  x = x - Ax(T,Q)  where 
xx  = 82.1678  + 352.8045  T 

2 h 

- (123954.8504  T + 43904.0083  T + 13423.6819) 

A x(TyQ)  = + ( — 2-2-'-36'  - + "T3;5  A (0.3  Q2  + 0.7  Q)  (11) 

\T  + .15  / 


To  insure  that  the  routine  will  not  fail  for  large  or  small  values  of  T 
certain  restrictions  on  T are  built  into  the  program.  The  nominal  value 
of  T is  forced  to  be  no  larger  than  950,000  and  no  smaller  than  10”^. 
This  forces  the  corresponding  limits  for  x of  -823.0473  < x < 39.14553. 


Finally  convergence  is  achieved  when 


T(x  ) - T 
n 


100000 


Having  solved  for  semimajor  axis  a , the 


r r sin9 
1 2 


c 


Then  the  eccentricity  e is  given  by 


P 

e = 1 - — 

a 


semilatus  rectum 


p is  given  by 
I 2 

(12) 

i 

(13) 
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(2)  Lesh,  H.  F. , and  Travis,  C.,  FLIGHT:  a Subroutine  to  Solve  the 
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ELITE  Flow  Chart 


FLITE-4 


Enforce  restrictions  on  x 
K 


T (x)  - T 
T'(x) 


■f 


Compute  T'.(x) 


GAIN  1-1 


GAIN1  Analysis 


Subroutine  GAIN1  computes  the  Kalman-Schmidt  filter  gain  matrices 

and  S^^  that  are  used  in  subroutines  GNAVM  and  NAVM  to  update 

estimation  error  covariance  matrices  after  a measurement  has  been 
processed. 


The  measurement  residual  covariance  matrix  an<*  t*ie  auxiliary 

matrices  A^+^  and  B ^ are  assumed  to  be  available  (from  GNAVM  or 

NAVM)  when  GAIN1  is  called.  Subroutine  GAIN1  then  evaluates  the 
following  equations  to  determine  the  filter  gain  matrices: 


^+1  ~ \+l  Jk+1 

(1) 

Sk+1  = Bk+1  Jk+1 

(2) 
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GAIN2-1 


GAIN2  Analysis 


Subroutine  GAIN2  computes  filter  gain  matrices  and 

for  an  equivalent  recursive  weighted-least-squares  (WLS)  consider 
filter.  The  equations  required  to  compute  and  are  iden- 


tical to  those  used  to  compute  the  Kalman  filter  gains,  but  with 
all  consider  parameter  covariances  removed. 


Subroutine  GAIN2  propagates  and  updates  (at  a measurement)  a 
set  of  covariance  matrix  partitions  that  are  completely  inde- 
pendent of  those  processed  in  subroutines  NAVM  or  GNAVM  for  the 
sole  purpose  of  generating  filter  gain  matrices  anci  ^k+1' 


The  propagation  and  update  equations  employed  in  GAIN2,  which 
are  a subset  of  the  NAVM  and  GNAVM  propagation  and  update  equa- 
tions, are  summarized  below.  For  definitions  of  all  matrices, 
see  either  the  subroutine  NAVM  or  GNAVM  analysis  section. 


Propagation  equations: 

T \ 

+ 4-  \ + - X 

p.  = l<J>p,  + e c |4>+c  e + q. 

k+1  i k xx  xx  I xx  xx  k 

S Sk/  Sk+1  S 


— ”h  + 

C = 4>C  +0  P 

XX  XX  XX  s, 

sk+l  sk  3 k 


p = p . 

sk+l  Sk 


Gain  equations: 


\+l  = Pk+1  Hk+1  + Cxx  \+l 

s, 


k+1 


.T  , „T 

r 

Jk+1  ” _ s. 


Bk+1  Ps,  . , “k+1  + Cxx.  ^k+l 


k+1 


Jk+1  “ \+l  \+l  + ^+1  \+l  + \+l 


(1) 

(2) 

(3) 

(A) 

(5) 

(6) 
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*1*1  - \+1  Jjli 

sk+l  = Bk+1  jk+l 

Update  equations: 

Pk+1  = Pk+1  " \+l  \+l 

+ - T 

C - C - K,  - B,  , . 

XX  XX  ic+1  k+1 

Sk+1  Sk+1 

+ T 

P = P - S.  ..  B. 

Sk+1  Sk+1  k+1  k+1 


(7) 

(8) 

(9) 

(10) 

(ID 
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GAIN2  Flow  Chart 


( ENTER  ) 

f 

I FLAG 

= 0 

Has  an  event  occurred  since 
the  last  measurement  at  time 


Propagate  covariance  matrix 
partitions  from  t^  to  t^+« 


Compute  filter  gain  matrices 


Update  covariance  matrix 
partitions  at  t^. 

Symmetrize  Pt  , and  P+ 

i 5 i, . i 


INFLAG  = 0?  ■ ■ 

NO 

Restore  NDIM2 , NDIM3,  NDIM4, 
and  all  state  transition 
matrix  partitions 


Restore  TRTM1  and  DELTM 
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GAUSLS-1 


GAUSLS  Analysis 

GAUSLS  is  a hybrid  algorithm  to  obtain  a least-squares  solution  to 
the  system 


1 (x)  = 0 (1) 

where  x.  is  an  n-dimensional  control  vector,  jp  is  an  m-dimensional 
constraint  vector,  and  m > n.  Current  array  dimensions  in  GAUSLS 
require  that  n £ 5 and  m < 10.  By  least-squares  we  mean  that  the 
square  of  the  standard  Euclidean  norm  of  namely 


(2) 


is  minimized.  The  principal  algorithm  used  is  the  well-known  pseudo- 
inverse scheme  originally  due  to  Gauss.  When,  however,  the  depend- 
ence of  | on  x deviates  substantially  from  the  approximate  linearity 
tactily  assumed  by  the  Gauss  method,  a best-step  steepest  descent 
algorithm  is  invoked.  Either  of  two  indications  of  nonlinearity 
can  cause  GAUSLS  to  transfer  from  the  normal  pseudo-inverse  mode 
to  best-step  steepest  descent  technique:  (1)  the  Gauss  control  cor- 

rection is  larger  in  norm  than  an  input  upper  bound  , s^,  or  (2) 

the  Gauss  step  actually  increases  the  miss  index,  | |$J  |2,  over  the 
previous  iterate. 


The  Gauss  procedure  can  readily  be  derived  since  it  is  simply  the 
exact  one-step  solution  to  equation  (1)  when  jj>_  depends  on  x lin- 
early. Let  J represent  the  Jacobian  or  sensitivity  matrix  of  ^ 
with  respect  to  _x;  that  is 


3d) . 

J = —■ 
1] 


i=l, . . . ,m 
j=l» • • • 

m > n 


(3) 


Next  let  y denote  the  least-squares  miss  index;  that  is 


y = 111  | 


2 


(A) 
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Then  the  gradient  of  the  miss-index  is  simply 

Vy  = 2 jt  4 . (5) 

Now  a necessary  condition  for  the  miss-index  to  be  minimized  after 
a control  correction  of  &x  is 

Vy  (x  + Ax)  = 0^  (6) 

Substituting  equation  (5)  into  (6)  gives 

2 / (x  + Ax)  _<£.  ( x.  + Ax)  = 0^  (7) 

Assuming  J either  constant  or  approximately  so  and  using  the  first 
two  terms  of  the  Taylor's  series  for  yields  the  approximation 

2 JT  [|(x)  + JAx]  = 0 (8) 

Solving  for  the  control  correction  then  yields  the  pseudo-inverse 
control  correction 

Ax  = -(JTJ)_1  JT.£(x)  . (9) 


Clearly  equation  (9)  is  exact  if is  a linear  function  of  x so  that 
the  Taylor  series  of  (x  + Ax)  has  only  two  terms  and  J is  inde- 
pendent of  x.  Since  one  can  reasonably  expect  that  if  the  depen- 
dence of  | on  x is  approximately  linear,  formula  (9)  can  be  applied 
iteratively  to  yield  a convergent  sequence  of  control  vectors  con- 
verging to  the  least-squares  solution  and  one  arrives  at  the  Gauss 
algorithm,  namely. 


Ax^.  = UTJ)  1 


iSk+1  = 2£k  + A^k 


(10) 


k = 0,1,2,... 


(ID 
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where  Xq  is  an  initial  control  estimate  suggested  by  other  sources. 

GAUSLS  requires  as  an  input  parameter  this  zero-iterate  control 
estimate,  together  with  the  corresponding  constraints  ^(x^)  . 

Since  equation  (6)  only  guarantees  an  extremum  of  the  miss  index 
(i.e.,  a minimum,  a maximum,  or  an  inflection  point),  no  more  can 
be  said  for  the  Gauss  algorithm.  It  must  be  assumed  that  the  ini- 
tial estimate  of  Xq  is  sufficiently  near  a local  minimum  and  that 

y is  well  enough  behaved  that  the  algorithm  indeed  leads  to  that 
minimum.  It  is  interesting  to  note  that  in  the  case  that  m =■  n, 
equations  (10)  and  (11)  reduce  to  the  familiar  Newton-Raphson  scheme 
for  solving  nonlinear  systems  of  equations. 

The  logic  behind  the  steepes t-descent  mode  is  less  elegant  but  more 
straightforward  than  the  Gauss  procedure.  First,  the  gradient  of 
the  miss  index  is  computed  via  equation  (5) . Next  a search  is  con- 
ducted in  the  negative  gradient  direction  until  the  miss  index  is 
observed  to  begin  increasing.  Let  a denote  the  step  length  in  the 
search  direction  where  y is  first  observed  to  increase.  Then  the 
subroutine  THP0SM  is  called  to  find  a minimum  of  y on  the  step 
length  interval  from  0 to  a by  cubic  interpolation.  Let  denote 

the  step  length  value  corresponding  to  the  minimum  returned  by 
THP0SM.  Then  the  control  correction  for  the  kth  iterate  is  taken 
to  be 


AXfe  - -^Zy/llvyll  . (12) 


The  convergence  of  this  scheme  is  only  asymptotic  with  no  accel- 
eration as  the  minimum-miss  controls  are  approached.  Nevertheless, 
the  steepest  descent  algorithm  seems  to  be  the  best  available  for 
extremely  nonlinear  miss  indices  since  it  involves  no  linear  extra- 
polation and  since  it  searches  in  the  only  direction  in  which  im- 
provement is  guaranteed.  Its  poor  terminal  convergence  is  no 
handicap  in  the  hybrid  GAUSLS  routine  because  once  the  iteration' 
sequence  falls  inside  a suitably  linear  region  about  the  miss-index 
minimum,  the  rapidly  convergent  Gauss  scheme  takes  over. 


GAUSLS  calculates  the  Jacobian  matrix  J by  numerical  differencing 
through  a call  to  the  subroutine  JAC0B.  Hence  the  user  is  required 
to  supply  a perturbation  size  6 to  GAUSLS  for  us  by  JAC0B  in  ap- 
proximating J by  the  forward-divided  difference 


J 


ij 


[ 4>±  (Xj  + 6)  - (j>1  (x^)  ] 

6 


(13) 
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The  user  could  conceivably  use  an  analytical  Jacobian  matrix  by 
replacing  the  call  to  JAC0B  by  formulae  for  the  appropriate  par- 
tial derivatives. 

The  convergence  criterion  in  either  mode  of  GAUSLS  is  the  same. 
Adequate  convergence  is  assumed  when  a weighted  sum  of  the  length 
of  the  change  in  the  control  vector  and  the  magnitude  of  the  change 
in  the  miss  index  fall  below  a preassigned  value;  i.e., 


ci  1 1 A*l  I + c2  I Ayl  < e • (14) 


The  user  must  supply  C^s  C„>  and  e as  input  parameters  to  GAUSLS. 

To  expedite  convergences  tne  user  should  scale  the  components  of 
x so  they  are,  as  far  as  possible,  all  of  the  same  order  of  magni- 
tude, say  in  the  range  from  0.1  to  10.  This  scaling  makes  meaning- 
ful the  use  of  a single  perturbation  size  6 for  all  components  of 
jc  in  approximating  J and  avoids  numerical  problems  in  matrix  inver- 
sion and  search  direction  calculation.  Further  he  must  supply  as 
an  input  parameter  the  maximum  number  of  iterations  he  will 


allow  before  terminating  the  algorithm. 


GAUSLS  supplies  enough  output  to  adequately  monitor  either  mode 
of  the  iterative  least-squares  process.  Initially  under  the  heading 
"Gauss  Least-Squares  Routine,"  it  prints  out  all  of  the  input  param- 
eters. These  include  n,  m,  6,  C. , C_,  e,  s„^  and  k . Next 

the  user-supplied  initial-control  estimate  Xq»  together  with  the 

corresponding  miss  index  y(Xg) » are  printed  out  under  the  heading 

"Gauss  Iteration  Point."  Then  the  printout  relative  to  the  gen- 
eral kth  iterate  begins.  All  data  concerning  the  Jacobian  matrix 
J are  printed  from  the  subroutine  JAC0B  under  the  heading  "Jacobian 
Matrix  Routine."  Each  iterate,  of  course,  starts  with  a Jacobian 
matrix  computation  even  if  it  eventually  ends  in  a steepest- 
descent  step.  All  of  the  control  vectors  and  corresponding  con- 
straint vectors  that  go  into  the  approximation  of  the  Jacobian 
matrix  are  printed  under  the  heading  "Nominal  and  Perturbed  Func- 
tion Values."  The  divided-difference  approximation  to  J is  then 
printed  under  the  heading  "Jacobian  Matrix."  Next  GAUSLS  prints 
out  the  Gauss  pseudo  inverse  matrix,  (J^J)-^  J^,  under  the  heading 
"Projection  Matrix."  Finally  the  next  Gauss  control  vector  iter- 
ate, the  corresponding  miss  index,  and  the  gradient  magnitude  of 
the  previous  iterate  are  printed  out  under  the  heading  "Gauss  Iter- 
ation Point."  If  the  length  of  the  control  correction  Ax  exceeds 
8q,  however,  the  miss  index  is  neither  calculated  nor  printed. 
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If  the  Gauss  iterate  is  such  that  a steepest-descent  step  is  re- 
quired, GAUSLS  prints  out  all  of  the  pertinent  data.  Under  the 
heading  "Cubic  Interpolation  Routine"  are  printed  all  trial  step 
lengths  and  corresponding  miss  indices  used  in  bracketing  the  mini- 
mum, the  input  parameters  to  the  routine  THP0SM,  and  the  minimum 
miss  step  length  and  index  are  returned  by  THP0SM.  If  the  miss 
index  decreases  monotonically  in  the  search  direction,  a message 
to  that  effect  is  printed  out  and  execution  of  the  program  is 
stopped.  Finally  the  steepest  descent  control  iterate  and  the 
corresponding  miss  index  is  printed  out  under  the  heading  "Best- 
Step  Steepes t-Descent  Iteration  Point."  The  iteration  printout 
then  is  repeated  with  each  successive  iterate.  When  convergence 
finally  occurs,  the  message  "Adequate  convergence  occurred  on  pre- 
vious step"  is  printed  after  the  last  iterate  and  the  convergence 
flag,  IC0NV1  is  set  to  1.  If,  on  the  other  hand,  convergence  fails 

to  occur  in  k iterations,  the  message  "Convergence  did  not  oc- 
max 

cur"  is  supplied  after  the  last  iteration  point  and  IC0NV1  is  set 
to  2.  After  either  of  these  two  stopping  conditions  is  reached, 
a summary  of  the  iteration  points  is  printed  under  the  heading 
"Iteration  History."  This  summary  contains  the  control  vector, 
the  miss  index,  and  the  gradient  to  the  miss  index  at  each  of  the 
iterates  in  consecutive  order. 
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GAUSLS  Flow  Chart 
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GENGID  Analysis 

Subroutine  GENGID  controls  the  execution  of  generalized  guidance 
events.  Generalized  guidance  has  been  extended  to  all  guidance 
options  defined  for  subroutine  GUIDM  except  for  biased  aimpoint 
guidance  and  impulse  series  thrusting. 

Unlike  GUIDM,  which  computes  target  dispersions  and  fuel  budgets 
based  on  filter-generated  statistics,  subroutine  GENGID  computes 
target  dispersions  and  fuel  budgets  based  on  actual  statistics. 
In  other  words,  the  generalized  covariance  technique  as  applied 
to  the  guidance  process  is  programmed  in  GENGID.  The  required 
equations  are  summarized  below. 


Before  the  guidance  event  at  time  t can  be  executed,  it  is  neces- 
sary to  propagate  the  actual  control  mean  and  control  2nd-moment 
matrix  partitions  forward  to  t ^ from  the  previous  guidance  event 


at  time  t . , . 

J-l 


The  control  mean  propagates  according  to 


x.  = $ x.  , + 0 x +0  U+0  w 

1 i-l  xx  s xuo  xwo 

J J so 


(1) 


where  $ , 0 


, 0 , and  0 

XX  XU  xw 

s 


are  state  transition  matrix  partitions 


over  the  interval 


and  x , x 


and  w denote  actual 


fj-1’  tj]'  ■ ' s- 

position/velocity  and  solve-for,  dynamic-consider , and  ignore  param- 
eter deviation  means.  The  notation  ( )'  indicates  actual  values 
as  opposed  to  the  unprimed  assumed  values,  while  ( ) and  ( )+ 
indicate  values  immediately  before  and  after  the  execution  of  the 
guidance  event,  respectively.  The  actual  control  position/velocity 
2nd-moment  matrix  is  defined  by 


= E 


h <]• 


(2) 


The  remaining  control  2nd-moment  matrix  partitions 
similarly.  The  propagation  equations  appearing  in 
GNAVM  are  used  to  propagate  the  control  2nd-moment 
tions  over  the  interval 


t . , , t .“I  • 

_J -1  J_ 


are  defined 
subroutine 
matrix  parti- 
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The  actual  target  state  deviation  <5t'  is  related  to  the  actual 


state  deviation  x'  at  time  tj  according  to 
J J 


6x  .*  = n . Xj 

j i i 


(3) 


where  is  the  variation  matrix  for  the  appropriate  midcourse 
guidance  policy.  The  mean  of  6x'  is  given  by 


E fix'  = n . E x' 
_ jj  3 l 


(4) 


The  statistical  target  dispersions  are  represented  by  the  actual 

(5) 


target  condition  2nd-moment  matrix  W',  which  is  defined  as 


Wj  E _6lj  6Tj_ 


*Ti  4tij- 

Substitution  of  equation  (3)  into  equation  (5)  yields 

wi  - "j  "jT  • 


(6) 


Equations  (4)  and  (6)  are  evaluated  immediately  before  and  after 
the  guidance  correction  to  determine  how  much  the  target  errors 
have  actually  been  reduced  by  the  velocity  correction  at  t . 

The  actual  commanded  velocity  correction  2nd-moment  matrix  is  de- 
fined by 


si‘E 


av:  AV 
J j 


where  the  actual  commanded  velocity  correction  is  given  by 


av:  = i\ 

3 j 


~ / a, 

x'  = r . | x . + x . 
3 3 \ 3 3 


(7) 


(8) 


The  guidance  matrix  T corresponds  to  the  appropriate  linear  mid- 
course guidance  policy.  The  equation  used  to  evaluate  S'  is  given 
by  J 


s'  * r 
j J 


ft  ■ si 


(9) 
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where  all  E 


of  equation  (9). 


_Xj  Xj  J 


terms  have  been  neglected  in  the  derivation 


The  mean  of  the  actual  commanded  velocity  correction  is  obtained 
by  applying  the  expectation  operator  to  equation  (8) : 


AV 


j 


( r /i  f"'b 

1 j [_  jj  |_  Jj 


(10) 


Since  this  equation  gives  no  useful  information  for  fuel-sizing 
studies j_  the  Hoffman-Young  formula  will  be  used  to  evaluate 

av: 
i 


av; 


' 2A  / x + B (tt  - 2) 

V 


A2 


(11) 


where 


A = trace  S' 
J 


B - X2  + X3+  X2  X3* 


and  A 

s;. 

J 


A and  A'  are  the  eigenvalues  of  the  2nd-moment  matrix 


The  actual  effective  or  statistical  AV  is  defined  as 


"E  JaV'J"  = E J]  AV ' |J  • a j 


(12) 


where  a'  denotes  a unit  vector  in  the  most  likely  direction  of 

the  velocity  correction.  The  most  likely  direction  is  assumed 
to  be  aligned  with  the  eigenvector  associated  with  the  maximum 
eigenvalue  of  ST. 


With 


"e  [av:  " 


available,  the  actual  execution  error  statistics 


can  be  computed  (by  calling  subroutine  GQC0MP).  These  are  the 


actual  execution  error  mean  E 


'V 


Q'  defined  as 


[S4V3 


and  2nd-moment  maxtrix 


GENG ID-4 


It  remains  to  summarize  the  equations  which  are  used  to  update 
all  actual  control  and  knowledge  means  and  2nd-moment  matrix  par- 
titions immediately  following  the  execution  of  a guidance  event. 
The  actual  estimation  error  means  and  2nd-moment  matrix  partitions 
are  updated  using  the  following  equations: 


l T 

where  A = [0  i I]  . The  actual  deviation  means  are  updated  using 
the  following  equations: 


E 

E 


(18) 

(19) 


The  entire  set  of  actual  control  2nd-moment  matrix  partitions  is 
updated  by  equating  them  to  the  corresponding  actual  knowledge 

2nd-moment  matrix  partitions  at  t+. 
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GENGID  Flow  Chart 
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GHA  Analysis 


Subroutine  GHA  computes  the  Greenwich  hour^ajigle  in  degrees  and  days  at 
some  epoch  T*  referenced  to  1950  January  1 O'.  Epoch  T*  is  computed  from 

T*  = J.  D.  + 2415020.0  - J.D.d„ 

0 REF 


where 


and 


J.D. 


Julian  date  at  launch  time  t referenced  to  1900 
, na i aH  o 

January  0 12  . 


J.D.,,,,-,  = Reference  Julian  date  2433282.5 
REi? 

= 1950  January  l^O^1  referenced  to  January  0^12^  of 
the  year  4713  B.C. 

2415020.0  = 1900  January  0^12^  referenced  to  January  0^12^ 
of  the  year  4713  B.C. 


Then  T*  is  the  Julian  date  at  launch  time  t referenced  to  1950  January 

ido\ 


The  Greenwich  hour  angle  corresponding  to  T*  is  given  by 

GHA(T*)  = 100.0755426  + 0.985647346d  + 2.9015  x 10"13  d2  +<at 
where  0 - GHA(T*)  < 360? 

and  d = integer  part  of  T*,  t = fractional  part  of  T*, 

and  0)  = Earth's  rotation  rate  is  degrees/day. 

GHA 

The  Greenwich  hour  angle  in  days  is  given  by  . 
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GIDANS  Analysis 


GIDANS  is  an  executive  routine  responsible  for  processing  a guid- 
ance manuever  for  the  computation  of  the  velocity  increment  Av 
to  the  execution  of  the  correction. 

Before  entry  to  GIDANS,  TRJTRY  has  computed  the  index  of  the 
current  event  (KUR)  and  has  integrated  the  nominal  trajectory 
to  the  time  of  the  event.  GIDANS  now  evaluates  the  KUR  compo- 
nent of  two  integer  arrays  — KTYP  and  KMXQ.  The  values  of 
these  flags  determine  the  operation  of  GIDANS.  The  flag  KTYP 
specifies  the  type  of  guidance  event  to  be  performed,  while 
KMXQ  prescribes  the  compute/execute  mode  to  be  used  according  to 

KTYP  = -1  Termination  event 

1 Targeting  event 

2 Retargeting  event 

3 Orbit  insertion 

4 Main  probe  propagation 

5 Miniprobe  targeting 

KMXQ  = 1 Compute  only 

2 Execute  Av  only 

3 Compute  and  execute  A^ 

4 Compute  but  execute  Av  later 

GIDANS  first  checks  for  a termination  event.  If  the  current 
index  prescribes  such  an  event,  the  flag  KWIT  is  set  to  1 and 
a return  is  made  to  the  main  program  N0MNAL. 

In  prepration  for  a normal  guidance  event,  GIDANS  calls  VMP 
with  the  current  spacecraft  heliocentric  state  and  a time  incre- 
ment of  zero  to  restore  the  F and  V arrays  providing  the  current 
geometry  of  spacecraft  and  planets.  If  the  current  event  is  an 
execute-only  mode,  the  transfer  is  made  to  the  execution  section 
of  GIDANS  for  the  addition  of  the  preset  velocity  increment. 

Otherwise  GIDANS  interrogates  KTYP  for  the  type  of  maneuver  to 
be  computed.  For  a targeting  event,  subroutine  TARGET  is  called 
directly  for  the  computation  of  the  Av  necessary  to  satisfy  input 
target  conditions.  After  calling  TARGET,  the  F and  V arrays  are 
restored  as  indicated  above. 
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A retargeting  event  is  defined  as  a targeting  event  that  requires 
computation  of  a new  zero  iterate.  Thus  a retargeting  event  is 
an  event  in  which  the  current  nominal  state  when  integrated  for- 
ward would  miss  the  target  conditions  badly.  Such  an  event  would 
be  the  broken-plane  correction.  For  this  event  TRJTRY  stores  the 
current  position  (and  possibly  the  target  position)  in  the  ZDAT 
array.  It  then  calls  ZERIT  for  the  computation  of  the  massless- 
planet's  initial  velocity  consistent  with  the  target  conditions. 

It  then  operates  identically  to  the  targeting  event. 

The  third  guidance  maneuver  is  the  insertion  event.  GIDANS  calls 
INSERS  for  the  computation  of  the  velocity  increment  Av  and  the 
time  interval  At  before  it  is  to  be  executed. 

The  main-probe  propagation  event  involves  storing  the  current 
spacecraft  state,  propagating  the  main  probe  to  an  appropriate 
stopping  condition  while  printing  a time  history,  and  restoring 
the  original  state  in  preparation  for  the  next  event.  It  is 
carried  out  in  a single  call  to  the  subroutine  MPPR0P.  Upon 
return  to  GIDANS,  the  F and  V arrays  are  restored  as  indicated 
above . 

The  miniprobe  targeting  event,  although  somewhat  complicated, 
is  completely  executed  by  the  single  subroutine  TPRTRG.  The 
current  bus  state  is  first  stored.  Next  the  miniprobe  release 
controls  are  calculated  to  apply  at  the  current  time  to  target 
three  miniprobes  respectively  to  three  target  sites  character- 
ized by  imput  values  of  declination  and  right  ascension.  Using 
the  minimum-miss  release  controls,  each  miniprobe  is  then  propa- 
gated from  release  to  a stopping  condition  while  a time  history 
is  concurrently  printed.  Finally,  the  original  bus  state  is  re- 
stored. On  returning  to  GIDANS,  the  F and  V arrays  are  restored 
as  usual . 

The  three  subroutines  TARGET,  INSERS,  and  TPRTRG  signal  trouble 
to  GIDANS  via  the  flag  KWIT . If  problems  are  encountered  in 
their  execution,  e.g.,  failure  to  converge  in  TARGET  or  TPRTRG  or 
the  impossibility  of  insertion  in  INSERS,  KWIT  is  set  to  1. 
Otherwise  KWIT  =0.  On  return  to  N0MNAL,  if  KWIT  = 1 the  current 
case  is  terminated  while  if  KWIT  = 0 it  is  continued. 

If  the  current  event  is  a compute-only  mode,  TRJTRY  now  sets 
KWIT  = 0 (so  that  the  program  will  continue  regardless  of  whether 
the  correction  computations  were  successful)  and  returns  to  N0MNAL 
However  if  the  current  event  failed  (KWIT  = 1)  and  was  to  be  exe- 
cuted (KMXQ  ^ 1)  GIDANS  consideres  this  a fatal  error  for  the  cur- 
rent case  and  returns  with  KWIT  ■=  1. 
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If  the  compute/execute  mode  is  compute-execute  later  (KMXQ  = 4) 
as  is  the  insertion  event, ^GIDANS  now  sets  up  for  the  subsequent 
execute-only  event.  The  Av  computed  is  stored  in  the  DELV  array, 
the  time  of  the  execution  is  computed  = t^  + At ) and  stored 

in  the  TIMG  array,  and  the  KMXQ  flag  is  set  to  a 2 (execute-only) . 
The  return  is  then  made  to  N0MINAL. 

For  an  event  to  be  executed  at  the  current  time  (KMXQ  = 2,3), 
GIDANS  now  calls  EXCUTE  for  the  completion  of  that  task. 

It  should  be  noted  that  for  all  events  that  are  completed  at 
this  time,  the  KUR  components  of  the  KTIM  array  are  set  equal 
to  0 so  they  are  no  longer  considered  in  determining  the  next 
event  in  TRJTRY.  Only  in  the  case  of  KMXQ  = 4 is  the  KTIM  flag 
nonzero  on  exit  from  GIDANS. 
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RETURN 


Set  up  geometric  arrays  F,V  for  current  state 


Call  TARGET 
Restore  F,V  array 


Set  up  ZDAT  array 
Call  ZERIT 
Call  TARGET 
Restore  F,V  array 


Call  MPPR0P 
Restore  F,V  array 


Call  TPRTRG 
Restore  F,V  array 


KWIT 

KTIM 

= 0 
= 0 

c RETURN 

Store  Av , t 
KMXQ  = 2 
KTIM  = 1 


RETURN 


KMXQ  = ? 

X 

KWIT  = ? 

X 

KMXQ  = ? 


Call  EXCUTE 
KTIM  = 0 


RETURN 


Flag  Definitions 
KTYP  = -1  Termi 


1 Termination  event 

1 Targeting  event 

2 Retargeting  event 

3 Orbit  insertion 

4 Main  probe  propagation 

5 Mini  probe  targeting 


KMXQ  = 1 Compute  av  only 

= 2 Execute  av  only 

3 Compute  and  execute  Av 

4 Compute  but  execute  av 

later 

KWIT  = 0 Continue  case 

= 1 Problem,  terminate  case 

KTIM  i 0 Guidance  event  to  be 
processed 

= 0 Event  already  processed 


184-1 


GNAVM-1 


GNAVM  Analysis 

Subroutine  GNAVM  propagates  and  updates  (at  a measurement)  both 
assumed  (or  filter)  covariance  matrix  partitions  and  actual  2nd 
moment  matrix  partitions.  The  equations  programmed  in  GNAVM  are 
independent  of  the  filter  algorithm  employed  to  generate  gain 
matrices . 


The  covariance  and  2nd  moment  matrix  partitions  manipulated  by 
GNAVM  are  defined  as  follows: 


P = E [x  xT] 


s 


C 

XU 


C 

XV 


C 

xw 


E [x  uT] 
E[x  vT] 
E[x  wT] 


P = 
s 


C 

X u 
s 


C 

X V 

s 


C 

X w 
s 


= E[xs  UT] 

= E [x  vT] 
s 

= E[x  WT] 

s 


(1) 


The  following  matrix  partitions  are  used  in  GNAVM,  but  are  not 
changed  in  GNAVM: 


c 

E [ u 

~Tt 
v ] 

uv 

C 

E[u 

~T 
w ] 

uw 

C 

E [v 

-T, 
w ] 

vw 

U = 

E [u 

~T  -i 

u ] 

V = 

E [ v 

~Ti 

v ] 

W = 

E [w 

w ] . 
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In  these  definitions  x,  x , Q,  v,  and  w represent,  respectively, 

s 

the  estimation  errors  in  position/velocity  state,  solve-for  param- 
eters, dynamic  consider  parameters,  measurement  consider  parameters, 
and  ignore  parameters.  Ignore  parameters,  of  course,  are  not  de- 
fined when  assumed  (or  filter)  covariance  matrix  partitions  are 
being  propagated  or  updated.  Furthermore,  the  assumed  C has  been 
set  to  zero.  uv 

The  equations  used  to  propagate  covariances  or  2nd  moment  matrices 

from  time  t,  to  t,  are  summarized: 
k k+1 


k+1 


-{< 


+T  +T  +T  \ T 

+ 9 C +0  C + 0 C ] <t> 
XX  XX  XU  XU,  xw  xw,  j 

S S,  tC  K / 

k 


— T T — T 

+ C 9 + C 6 +C  ql  + Q 

“s  XVl  **  *Vl  ™ k+1 

k+1 


xx 


k+1 


+ + +T  +T 

= $C  +0  P +0  C +0  C 

XX  XX  S,  XU  X U XW  X w 

s,  s k s , s , 


C"  = <J>C+  +0  C+  +0  U+0  CT 

XUj^+^  XU^  XXg  XgU  XU  o xw  uw^ 


c”  = $C+  + 9 C+  + 6 C + 0 CT 

XV,  , , XV,  XX  X V XU  uv  xw  vw 

k+1  k s s , o o 

k 


xw 


k+1 


$C+  + 0 C+  + 0 C + 0 W 

XW,  XX  X W XU  uw  xw  o 

k s s , o 


p - p 
sk+l  sk 


C ■ C 

XU  XU 

8 k+1  8 k 


(3) 

(4) 

(5) 

(6) 

(7) 

(8) 

(9) 
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x v 
s 


* C 


k+1 


x v 
s , 


(10) 


X w 
s 


k+1 


x w 
S , 


(11) 


In  these  equations  ( ) indicates  immediately  prior  to  processing 

a measurement;  ( )+,  Immediately  after.  The  state  transition  ma- 
trices over  the  interval  [ t.  , t,  ..  ] are  indicated  by  4>,  0 , 0 , 

K K"r  _L  XX  XU 

S 

and  6 . The  dynamic  noise  covariance  or  2nd  moment  matrix  is  de- 

xw 

noted  by  Qk+1. 

Before  covariance  (or  2nd  moment)  matrix  partitions  can  be  updated 
at  a measurement,  the  measurement  residual  covariance  (or  2nd  moment) 
matrix,  defined  by 


Jk+1  ” E|£k+1  ek+l 


(12) 


must  be  computed.  The  required  equations  are  summarized 


Jk+1  = H\+l  + ^k+l  + GDk+l  + LEk+l  + NFk+l  + \+l 


(13) 


= P.  ,i  H + c 
x+1  k+1 


XX 


T 

M + C 


k+1 


X\+l 


T 

G + C 


xv, 


T 

L + C 


k+1 


xv; 


N (14) 


k+1 


-T-T  T - T T - T (15) 

B,  , = P M + C H + C G + C L + C N v ' 

k+1  s.  . , xx  xu  xv  xw 

k+1  s . , _ s , . s , , s . , 

k+1  k+1  k+1  k+1 


rn  rri  m rp  rp  rn  rp 

D.  = C~  H + C M + U G1  + C'  N + C L 

k+1  xu,  . , xu  o uw  uv 

K+1  S , . , O O 

k+1 


(16) 


E,  , = C_J"  HA  + C M + C N + V L + C G 

k+1  xv,  , , xv  vw  o uv 

k+1  s , , . o o 

k+1 


(17) 
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rp  rp  rp  pp  Pp 

F.  , , = W N + C H + C M + C L + C 

k+l  o xw.  . i x w vw  uw 

k+1  s , . , o c 

k+l 


In  these  equations  H,  M,  G,  L,  and  N represent  observation  matrix 
partitions,  and  represents  the  measurement  noise  covariance 

(or  2nd  moment)  matrix. 


Gain  matrices  and  Sk+^  are  also  required  before  covariance 

(or  2nd  moment)  matrix  partitions  can  be  updated.  These  are  not 
computed  in  GNAVM  but  are  obtained  by  calling  either  subroutine 
GAIN1  or  GAIN2,  depending  on  which  recursive  estimation  algorithm 
is  desired. 


With  Jfc+1,  Kk+1,  and  Sk+1  available, 
used  in  the  updating  process: 


the  following  equations  are 


■ pk+i  - \+i  aT  - + Vi 


C = C 

XX  XX 

Sk+1  Sk+1 


^+1*  - ASk+l  + \+l  Jk+1  Sk+1 


(19) 

(20) 


sk+l  Sk+1 


C+  = c"  - K,  - 

XUk+l  XUk+l  ^+1 

dt 

(21) 

c+  = C"  - K,  - 

xvk+l  XVk+l  *C+1 

dt 

(22) 

c+  = c~  - 1C 

“'k+l  “'k+l  X+1 

ft 

(23) 

■ S BT  - BS*  + S • J S* 

k+l  k+l  k+l  k+l  k+l 

(24) 

+ T 

C = C - S,  ..  D 

x u xu  k+l 

s k+l  s k+l 

(25) 

(18) 
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+ - T 

C = c - s,  ..  ea 

xv  xv  k+1 

S k+1  S k+1 


+ T 

C = C - S F1 

x w x w k+1 

S k+1  S k+1 


(26) 

(27) 


It  should  be  noted  that  propagation  equations  (3)  through  (11)  are 
also  used  to  propagate  both  assumed  control  covariance  and  actual 
2nd  moment  matrix  partitions  over  the  time  interval  separating  two 
successive  guidance  events.  The  update  equations,  of  course,  are 
not  used  in  this  situation. 
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GNAVM  Flow  Chart 
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GQC0MP  Analysis 


Subroutine  GQC0MP  computes  the  actual  execution  error  mean  and 
2nd  moment  matrix  for  use  in  the  generalized  covariance  analysis 
of  a guidance  event.  The  actual  execution  error  6AV',  is  assumed 
to  have  the  form 


i 


6AV^  = k'  AVj  + s ' 


AV' 

|AV’| 


+ <5AV'  , _ 

pointing 


(1) 


where  k'  denotes  the  actual  proportionality  error;  s',  the  actual 
resolution  error;  6AVpo^nt^n^,  the  actual  pointing  error;  and 

AV^ , the  actual  commanded  velocity  correction. 


The  means  of  the 

three 

ecliptic 

E[6AV' ] = 

(k'  + 

p 

AV'  + 

X 

p / 

X 

E[6AV' ] ® 

k’  + 

p 

AV'  + 

y 

\ 

y 

E[6AV' ] = 
z 

|k'  + 

$ 

AV'  - 
z 

p ' AV'  6a'  + AV’  AV'  63' 
I x z 


AV'  AV'  63 ’ - p'AV'  6a' 
y z x 


(2) 

(3) 

(4) 


where  p'  = |AV'|,  p'  = [AV'2  + AV'2]*5,  and  6a'  and  63'  are  the 

x y 

ac tual  pointing  angle  errors,  and  both  E(  ) and  ( ) indicate  mean 
values . 

The  actual  execution  error  2nd  moment  matrix  is  defined  by 


= E jsA  Vj  6AV^ 


(5) 


the  elements  of  matrix  are  given  as: 

Q'  = £'  AV'2  + -L(p'2AV'2  6a'  6a'  + AV'2  AV'2  63'  63'  + • 

11  x PTZ  \ y x z 

_ _ \ 2AV'  / __  v 

6a'  63')  + — A C*  ( P AV'  6a'  + AV'  AV'  S3'l 

/ v \ y x z J 


2p ' AV'  AV'  AV' 
x y z 


(5) 
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QI,  - v AV'2  + p'2  6g'  66'  - 2A$'  p'  c'  66' 
33  z z 


q; 


12 


Q'  = V A$'  AV'  + -^r 
21  x y p' 


1 

7T2 


AV’  AV*  AV'2  66'  66' 
x y z 


6a' 

— 

' i _ 

p'  AV'  6a 

X 

(7) 

r«2 

- Atf'2)^' 

X 

y / 

r'2) 

6oi'  66'  + 

X / 

(8) 

AV' 

z 


qi3  = q3i  = av;  av;  + K 


r (p'AV'  6a'  -i-  av  av  otJ'i-  p ' 

\ y x z l x 


+ AV'  AV'  66')-  u'  A$'  66' 


- p'AV'  6a'  66'  - AV'  AV'  66'  66' 
y x z 


(9) 


AV'  / „ 

Q’3  = Q'2  = 5*  A^  AV^  + c*  AV;  AV^  66 


’ - p’AV'  6a')-  p'  AV' 
x J y 


66' 


+ p'AV'  6a'  66'  - AV'  AV'  66'  66' 
x y z 


(10) 


where 


and 


V 


= k'  k'  H f k ■ s'  i-  — rr 

P P z 


-T  k'  s'  + 

s\  * 


s'  s' 
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C ' = k'  + — - 
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GUID  Analysis 


Subroutine  GUID  is  used  in  the  error  analysis  mode  to  compute  the  same 
quantities  which  subroutine  GUIS  computes  in  the  simulation  mode.  Sub- 
routine GUID  differs  from  GUIS  in  that  instead  of  calling  NTMS  and  VARSIM 
as  does  GUIS,  subroutine  GUID  calls  NTM  and  VARADA.  In  addition,  the 
state  transition  and  variation  matrices  computed  in  GUID  are  referenced  to 
the  targeted  nominal  since  the  most  recent  nominal  is  not  defined  for  the 
error  analysis  mode.  These  differences  entail  only  minor  logic  differences 
in  the  flow  chart  for  GUID,  and  for  this  reason  no  GUID  flow  chart  is  pre- 
sented. See  subroutine  GUIS  analysis  and  flow  chart  for  further  details. 
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GUIDM  Analysis 


Subroutine  GUIDM  is  the  executive  guidance  subroutine  in  the  error  analysis 
program.  In  addition  to  controlling  the  computational  flow  for  all  types 
of  guidance  events,  GUIDM  also  performs  many  of  the  required  guidance 
computations  itself. 


Before  considering  each  type  of  guidance  event,  the  treatment  of  a general 
guidance  event  will  be  discussed.  Let  t.  be  the  time  at  which  the  guidance 


event  occurs.  _Before  any  guidance  event  can  be  executed  the  targeted 

nominal  state  X.",  knowledge  covariance  Pi"  . and  control  covariance  P“" 

1 K , c . 

_ J J 

must  all  be  available,  where  ( ) indicates  values  immediately  before 

the  event.  The  first  two  quantities  are  available  prior  to  entering 
GUIDM.  However,  GUIDM  controls  the  propagation  of  the  control  covariance 
over  the  interval  [t^  ^ , t ] , where  t.  ^ denotes  the  time  of  the  previous 

guidance  event. 


The  next  step  in  the  treatment  of  a general  guidance  event  is  concerned 
with  the  computation  of  the  commanded  velocity  correction  and  the  execution 
error  covariance.  In  the  error  analysis  program  a non-statistical  velocity 
correction  is  computed  whenever  the  nominal  target  conditions  are  changed; 
otherwise,  only  a statistical  velocity  correction  can  be  computed.  The 


commanded  velocity  correction  AV.  is  then  used  to  compute  the  execution 

— 3 

error  covariance  matrix  Q A summary  of  the  execution  error  model  and 

J (V 

the  equations  used  to  compute  Q . can  be  found  in  the  subroutine  QC0MP 


analysis  section. 


The  last  step  is  concerned  with  the  updating  of  required  quantities  prior 
to  returning  to  the  basic  cycle.  An  assumption  underlying  the  modeled 
guidance  process  is  that  the  targeted  nominal  is  always  updated  by  the 
commanded  velocity  correction.  In  the  error  analysis  program  only  the 
non-statistical  component  is  used  to  perform  the  state  update  and  is 

A 

indicated  by  the  variable  AV  . Thuss  the  targeted  nominal  state 

j 

immediately  following  the  guidance  event  is  given  by 


X . = X . + 

J J 

j 
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The  knowledge  covariance  is  updated  using  the  equation 


0 . Q.J 


if  an  impulsive  thrust  model  is  assumed.  If  the  thrust  is  modeled^  as  a 
series  of  impulses,  then  an  effective  execution  error  covariance  Q ^ is 

computed  and  the  knowledge  covariance  is  updated  using  the  equation 


K. 


+ Q 


eff 


In  either  case  the  control  covariance  is  updated  simply  by  setting 


This  equation  is  a direct  consequence  of  the  assumption  that  the  targeted 
nominal  state  is  always  updated  at  a guidance  event. 

A "compute  only"  option  is  available  in  GUIDM  in  which  all  of  the  ( )+ 

quantities  will  still  be  computed  and  printed.  _However,  the  state  and  all 
covariances  are  then  reset  to  their  former  ( ) values  prior  to  returning 

to  the  basic  cycle. 

Each  specific  type  of  guidance  event  involves  the  computation  of  other 
quantities  not  discussed  above.  These  will  be  covered  in  the  following 
discussion  of  specific  guidance  events. 


1.  Midcourse  and  Biased  Aimpoint  Guidance 

Linear  midcourse  guidance  policies  have  form 


AVn  = r 8 X, 

Nj  J J 


where  the  subscript  N indicates  that  this  is  the  velocity  correction 
required  to  null  out  deviations  from  the  nominal  target  state.  This 
notation  is  required  to  differentiate  between  this  type  of  velocity 
correction  and  velocity  corrections  required  to  achieve  an  altered  target 
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state.  Linear  midcourse  guidance  policies  are  discussed  in  more  detail 
in  the  subroutine  GUIS  analysis  section. 


Subroutine  GU1DM  calls  GUID  to  compute  the  guidance  matrix,  F ^ » and  the 

target  condition  covariance  immediately  prior  to  the  guidance  event, 

W 


j 


and  then  uses  T.  to  compute  the  velocity  correction  covariance  S., 


which  is  defined  as 


Sj  E 


“V1  ] > 


and  is  given  by  the  equation 


SJ  " rj  (pc.  - PK.>rjT 
J 2 2 


This  equation  assumes  that  an  optimal  estimation  algorithm  is  employed. in 
the  navigation  process,  since  the  derivation  of  this  equation  requires  the 
orthogonality  of  the  estimate  and  the  estimation  error. 

A 

In  the  error  analysis  program  AV^  is  never  available  since  no  estimates 

/N  J /\ 

(5X.  are  ever  generated.  Only  the  ensemble  statistics  of  6X.  are  available 

2 J r ^ -> 

which  means  only  a statistical  or  effective  velocity  correction  "E  LAV^  J" 

j 

can  be  computed.  In  the  STEAP  error  analysis  program  this  effective  velocity 
correction  is  assumed  to  have  form 


"e[avh  ]"  = P 

i J I ot  . 


The  magnitude  p.  is  given  by  the  Hoffman-Young  approximation 


P 

2 
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where 

A = trace  = X^  + + X^» 

B = X^X^  + ^1^3  + ^2^3> 

and  X^,  X^>  A^  are  the  eigenvalues  of  S^..  The  direction  of  the  effective 

velocity  correction  is  assumed  to  coincide  with  the  eigenvector  correspond- 
ing to  the  maximum  eigenvalue  of  S..  This  eigenvector  is  denoted  by  a..  An 

alternate  model  assumes  the  direction  coincides  with  the  vector  (A^,  X2J  A3). 

If  planetary  quarantive  constraints  must  be  satisfied  at  a midcourse  correction, 
GUIDM  calls  BIAIM  to  compute  the  new  aimpoint  pi^  and  the  (non-statistical) 

bias  velocity  correction  . All  computations  in  BIAIM  are  based  on  linear 

j 

guidance  theory.  However,  an  option  is  available  in  GUIDM  to  recompute 
, but  not  pi  , using  nonlinear  techniques.  This  option  is  recommended 

Bj  J 

if  a biased  aimpoint  guidance  event  occurs  at  t^  = injection  time.  It 

should  also  be  noted  that  is  set  to  zero  if  t^  = injection  time  since 

it  is  assumed  that  the  injection  covariance  does  not  change  for  small 
changes  in  injection  velocity. 

After  the  updated  control  covariance  P+  has  been  computed,  the  target 

+ Cj 

condition  covariance  matrix  following  the  guidance  correction  is  com- 
puted using  the  equation 


+ + T 

"j - ”3  % ”3 


where  variation  matrix  tj.  has  been  previously  computed  in  subroutine  GUID. 


2.  Re-targeting 

In  the  error  analysis  (and  simulation)  program  a re-targeting  event 

is  defined  to  be  the  computation  of  a velocity  correction  AV  required  to 

RT 

achieve  a new  set  of  target  conditions  using  nonlinear  techniques.  Since 
the  original  targeted  nominal  will  be  used  as  the  zero-th  iterate  in  the 
re-targeting  process,  the  new  target  conditions  must  be  close  enough  to  the 
original  nominal  target  condition  to  ensure  a covergent  process. 
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It  should  be  noted  that  after  a re-targeting  event  the  new  target  condi- 
tions are  henceforth  treated  as  the  nominal  target  conditions. 

3.  Orbital  insertion 

An  orbital  insertion  event  is  divided  into  a decision  event  and  an 
execution  ev^nt.  At  a decision  event  the  orbital  insertion  velocity 
correction  AV^  and  the  time  interval  At  separating  decision  and  execution 

are  computed  based  on  the  targeted  nominal  state  at  t The  relevant 

equations  can  be  found  in  the  subroutine  CjBPINS  analysis  section  for  co- 
planar  orbital  insertion;  in  NpPINS,  for  non-planar  orbital  insertion. 
Before  returning  to  the  basic  cycle,  GUIDM  schedules  the  orbital  insertion 
execution  event  to  occur  at  t . + At  and  re-orders  the  necessary  event 

arrays  accordingly. 

At  an  orbital  insertion  execution  evejit  the  targeted  nominal  state  is  up- 


dated using  the  previously  computed  AVff 


In  addition,  the  planeto-centric 


equatorial  components  of  AV^  and  the  nominal  spacecraft  cartesian  and 
orbital  element  state  following  the  insertion  maneuver  are  computed. 

4.  Externally-supplied  velocity  correction 


At  this  type  of  guidance  event  the  targeted  nominal  state  is  simply 
updated  using  the  externally-supplied  velocity  correction  A\LV. 

JSjA 


Because  of  the  complexity  of  the  GUIDM  flow  chart,  a simplified  flow  chart 
depicting  the  main  elements  of  the  GUIDM  structure  precedes  the  complete 
GUIDM  flow  chart. 
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Write  out  complete  description 
of  guidance  event. 


^ IGUID (5 , II)  = ? 
2,3,4 


IGUID (1,11)  = ? 


Restore  state  vector, 
time,  and  knowledge 
covariance  matrix  par- j 

titions  to  their  t. 

J 

values.  Restore  ISPH. 


RETURN 


ISPH 

\ 

NO 

f 

tj  = injection  time?  

NO 

. \ 

' 

Compute  velocity  correction  co- 
variance  matrix  S^.  Write  out 

correlation  matrix  and  standard 
deviations.  Compute  and  write  out 
eigenvalues  and  eigenvectors. 

> 

/ 

<(  IGP  = 

= 2i  y 

\ 

NO 

/ 

Set  "E|^ 
to  zero. 


Compute  and  write  out 
hyperellipsoid  of  S . . 
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IQP  = 0? 


Use  simplified  method  for  computing 
"E  |AVN  j Write  out.  Compute 

and  write  out  Q,  and  its  eigen- 
values, eigenvectors,  and  hyper- 
ellipsoid. 


Use  Hoffman-Young  formula 
to  compute  "E^Av^  j ", 


Write  out. 


IGUID(3 , II)  = 0? 


Store  "E  A*VN . " in  DVN  array 

for  use  in  subroutine  BIAIM. 


Call  BIAIM  to  perform  biased  aim- 
point  guidance  event.  Return 
aimpoint  bias  velocity 

J /-. 

correction  AvuP->  an(*  execution 
j w 

error  covariance  matrix  Q.. 

J 


NO  / — YES 

/ tj  = injection  time?  \ 


GUIDM-12 
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Call  N0NLIN  to  compute 
nonlinear  bias  velocity 
correction.  Return  XDELV. 


KWIT  = 0? 
YES 


Set  AVup  to  XDELV. 

Compute  magnitude.  Write  out 
AVyp  and  its  magnitude. 


Write:  Nonlinear  guidance 
failed.  Linear  guidance 
will  be  employed. 


tj  = injection  time? 


\ 

NO 

/ 

CO 

Compute  Q # 
+ 

Set  IRET  = 

using 
"E  [AVN.  ] 

2. 

^ 

\ 

/ 

Write  out  correlation  matrix 
and  standard  deviations 

ro 

associated  with  Q.. 

J 

/ 

IRET  = ? 
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IGUID (1 , II)  > 4? 
NO 

y 

NN  = 3 

y _ 

IGUID (1 , II)  = 2? 


IGUID (5, II)  = ? 

(Is  velocity  correction  to  be  executed?) 
1,3  (YES) 


Store  PSAVE  array 
in  the  PI  array  so 
that  the  PI  array 
contains  the  know- 
ledge covariance 
just  before  the 
guidance  event. 


Update  and  write  out  targeted  nominal 
immediately  following  the  guidance 
correction. 


Update  state  vectors,  times,  and  control 
and  knowledge  covariance  matrix  partitions 
in  preparation  for  next  cycle.  Restore 
ISPH. 


RETURN 


GUIDM-16 


IGUID (1 ,11)  <3  or 
IGUID (1 , II)  = 7 ? 


Set  Avup  to  the  pre-specif ied 

■3  A 

DELV  array.  Write  out  AVup^ 

and  its  magnitude. 


Write:  Error  in 
IGUID  array. 


IGUID (I, II)  = 4 or  5 ? 


99731 


Define  Julian  date  at  orbital 
insertion  and  set  IG0  = 2. 


Compute  and  write  out  nominal 
spacecraft  state  relative  to  the 
target  planet  immediately  following 
orbital  insertion. 


r > 

9974 


Call  PECEQ  to  compute  the  trans- 
formation from  plane to-centric 
ecliptic  to  planeto-centric 
equatorial  coordinates. 


Compute  and  write  out  planeto- 
centric  equatorial  coordinates  of 
AVyp  and  the  relative  spacecraft 

s tate . 


Compute  target  planet  gravitational 
constant.  Call  CAREL  to  compute  the 
orbital  elements  of  the  spacecraft 
orbit.  Write  out  elements. 


W A 

Compute  Qj  using  AVyp _ . 


Set  IRET  = 2 
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Set  IX  = 1 and  JX  = II. 
Set  XIN  to  state  at  t . 

j 


Call  N0NLIN  to  perform 
re-targeting  event  (target 
variables  are  defined  in 
namelist).  Return  XDELV. 


Set  AVup^ 

to  XDELV. 

) 

' 

KWIT 

= 0 ?^> 

YES 

\ 

f 

^ IGUID  (5 , 1 

I)  = 2 ?^> 

Write:  Re- targeting 
failed . 


Update  nominal 

target  conditions 

IGUID (5, II)  = 

in  TN0MB  and  TN0MC  arrays. 

NO 

. y 

Write  out. 

( EXIT 

V 

J 

Compute  Q.  using  AVtTTJ  . Write 


out  AVIJp  and  its  magnitude. 

j 

Set  IRET  = 2 . 
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GUIS  Analysis 


Subroutine  CUIS  is  called  at  a midcourse  guidance  event  at  t.  in  the 

simulation  mode  to  compute  three  primary  quantities  for  the  selected  mid- 
course guidance  policy.  These  three  quantities  are  the  variation  matrix 
77  , the  target  condition  covariance  matrix  prior  to  the  velocity  correction 

j 

W.,  and  the  guidance  matrix  r . Three  midcourse  guidance  policies  are 

J j 

available:  fixed- time-of-arrival  (FTA) , two-variable  B-plane  (2VBP) , and 
three-variable  B-plane  (3VBP) . All  are  linear  impulsive  guidance  policies 
having  form 

Av.  = r <5x 

j j j 

_ a A 

where  CSV  is  the  commanded  velocity  correction,  and  6X  is  the  estimate 

j j 

of  the  spacecraft  position/velocity  deviation  from  the  targeted  nominal. 

The  relevant  equations  for  each  guidance  policy  will  be  summarized  below. 

The  variation  matrix  Y] . for  FTA  guidance  relates  deviations  in  spacecraft 
state  at  t.  to  position  deviations  at  time  of  closest  approach  tr& , and 
is  given  by 


V = ["0  i 0 1 

j L 1 I 2J 


where  |0 , l 0 1 is  the  upper  half  of  the  state  transition  matri 

L 1 > 2J 

The  guidance  matrix  for  FTA  guidance  is  given  by 

K'1  i -1]  - 


^ (CCA  ’ 


r = 

j 


The  variation  matrix  for  3VBP  guidance  relates  deviations  in  spacecraft 

state  at  t.  to  deviations  in  B*T,  B-R,  and  t„  , where  t is  the  time 
J O J-  b _L 

at  which  the  sphere  of  influence  is  pierced.  Unlike  the  variation  matrix 
for  FTA  guidance,  which  can  be  computed  analytically  or  by  numerical  differ- 
encing, the  3VBP  variation  matrix  must  always  be  computed  using  numerical 
differencing  since  no  good  analytical  formulas  are  available  which  relate 

deviations  in  spacecraft  state  at  t.  to  deviations  in  t . If  the 

J SI 

variation  matrix  is  written  as 


T V I V 1 
L 1 1 2 J 


then  the  guidance  matrix  for  3VBP  guidance  is  given  by 

-1 


r.  = 

j 


[ - 77  1 ??  ! -1 
L 2 1 • J 
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The  variation  matrix  for  2VBP  guidance  relates  deviations  in  spacecraft 
state  at  t to  deviations  in  B*T  and  B>  R and  is  given  by 

j 


rj. 

j 


■ (tSI’ 


where  M is  an  analytically  computed  matrix 
deviations  to  spacecraft  state  deviations  at 


state  transition  matrix  over 


V 

j 


If 


relating  B-T  and  B»R 
tg  j , and  0 (tgj ) t ) is 

V is  written  as 

j 


the 


then  the  guidance  matrix  for  2VBP  guidance  is  given  by 


r 

j 


I x T - 1 1 
| -B  (BB  ) B J 


All  state  transition  matrices  and,  hence,  all  variation  matrices  used  by 
the  above  three  guidance  policies  are  referenced  to  the  most  recent  nominal 
trajectory  for  improved  numerical  accuracy. 


Once  the  variation  matrix  V . is  available  for  any  of  the  above  guidance 
policies,  the  target  condition  covariance  matrix  can  be  computed  using 

T 

W = V P V 
j j cj  j 

where  P^  is  the  control  covariance  matrix  immediately  prior  to  the 
guidance  event. 


206 


to  state  at 
M matrix. 


RETURN 


Compute  time 


and  position 


and  velocity  magnitudes  at 
closest  approach. 


Write  out  closest  approach  con- 
ditions for  targeted  nominal. 
Write  out  M matrix. 


Define  variables  ATRANS , VINF, 
and  TMPR  required  for  biased 
aimpoint  guidance. 
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GUIS- 6 
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Write:  S0I  not  encountered 
on  most  recent  nominal. 
Returning  to  basic  cycle. 

^ 

Call  0RB  and  EPHEM  to  compute 
position  and  velocity  components 
of  target  planet  at  S0I  on  most 

r 

recent  nominal. 

r 

A 

( RETURN 

] 

V 

J 

Compute  inertial  ecliptic  position 
and  velocity  components  of  space- 
craft at  S0I  on  most  recent  nominal, 
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RETURN 


RETURN 
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GUISIM  Analysis 


Subroutine  GUISIM  is  the  executive  guidance  subroutine  in  the  simu- 
lation program.  In  addition  to  controlling  the  computational  flow  for 
all  types  of  guidance  events,  GUISIM  also  performs  many  of  the  required 
guidance  computations  itself. 


Before  considering  each  type  of  guidance  event,  the  treatment  of  a 
general  guidance  event  will  be  discussed.  Let  t^  be  the  time  at  which 

the  guidance  event  occurs.  Before  any  guidance  event^can  be  executed  the 

targeted  nominal  state  X.,  most  recent  nominal  state  X,,  estimated  state 

J J 

deviation  8X.  from  most  recent  nominal,  actual  state  deviation  5X^  from 

most  recent  nominal,  knowledge  covariance  P , and  control  covariance  P 

K . c , 

j j 

must  all  be  available,  where  ( ) indicates  values  immediately  before  the 
event.  Only  the  control  covariance  is  not  available  prior  to  entering 
GUISIM.  The  propagation  of  the  control  covariance  over  the  interval 
£tj  ^ , t jl > where  t^  ^ denotes  the  time  of  the  previous  guidance  event, 

is  performed  within  GUISIM. 


The  next  step  in  the  treatment  of  a general  guidance  event  is  con- 
cerned with  the  computation  of  the  commanded  velocity  correction,  execution 
error  covariance,  actual  execution  error,  and  actual  velocity  correction. 

In  the  simulation  program  a non-statistical  commanded  velocity  correction 
can  always  be  computed.  This  commanded  velocity  correction  AV.  is  used 

to  compute  the  execution  error  covariance  matrix  Q . and  the  actual  execu- 


tion error  8 AV..  A summary  of  the  execution  error  model  and  the  equations 
used  to  compute  and  oAV  can  be  found  in  the  subroutine  QCjDMP  analysis 
section.  The  actual  velocity  correction  is  then  computed  using  the  equation 


AV . = AV  . + 5AV  . 
J J J 


The  last  step  is  concerned  with  the  updating  of  required  quantities 
prior  to  returning  to  the  basic  cycle.  An  assumption  underlying  the 
modeled  guidance  process  is  that  the  targeted  nominal  is  always  updated 
by  the  commanded  velocity  correction.  In  the  simulation  program  the 
update  velocity  correction  AV^p  is  always  identical  to  the  commanded 


velocity  correction  AV  . This  is  in  contrast  to  the  error  analysis  program 

A A 


where  AV,.,,  is  equated  with  the  non-statistical  component  of  AV., 

UPj  3 


The 
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most  recent  and  targeted  nominal  states  immediately  following  the  guidance 
event  are  updated  using  the  equations 


X. 


A _ 


The  actual  and  estimated  state  deviations  from  the  most  recent  nominal  are 
given  by 

0 

5AV~ 


j 


~4-  A_ 

5X.  « 6X.  - <$X.  + 
J J J 


The  previous  4 equations  assume  an  impulsive  thrust  model.  If, 

Instead,  the  thrust  is  modeled  as  an  impulse  series,  then  an  effective 

estimated  state  X __  and  an  effective  actual  state  X are  computed, 
eff  eff  r 

The  equations  used  to  compute  these  effective  states  are  summarized  in 

the  subroutine  PULSEX  analysis  section.  The  previous  update  equations 

are  then  replaced  by  the  following  equations 


'VJ.  A 

x7  - x « 

j eff 


_+ 

x.  = xT 

j j 


~+  A 

= X - X CC 

j eff  eff 


a 4. 

ix3-° 


The  knowledge  covariance  is  updated  using  the  equation 

To 


4-  — 

P = P + 
K,  K, 

J j 


0 

_ _ L_ 

j 

0 Q . 

' J 
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if  an  impulsive  thrust  model  is  assumed.  If  the  thrust  is  modele^  as  a 
series  of  impulses,  then  an  effective  execution  error  covariance  Q ^ Is 

computed  and  the  knowledge  covariance  is  updated  using  the  equation 


K 


+ Q 


ef  f 


In  either  case  the  control  covariance  is  updated  simply  by  setting 


This  equation  is  a direct  consequence  of  the  assumption  that  the  targeted 
nominal  is  always  updated  at  a guidance  event. 

A "compute  only"  option  is  available  in  GUISIM  in  which  all  of  the 
( ) quantities  will  still  be  computed  and  printed.  However,  states, 
deviations,  and  covariances  are  then  reset  to  their  former  ( ) values 
prior  to  returning  to  the  basic  cycle. 


Each  specific  type  of  guidance  event  involves  the  computation  of 
other  quantities  not  discussed  above.  These  will  be  covered  in  the 
following  discussion  of  specific  guidance  events. 

1.  Midcourse  and  biased  aimpoint  guidance. 

Linear  midcourse  guidance  policies  have  form 


AV. 


N, 


A 


where  the  subscript  N indicates  that  this  is  the  velocity  correction 
required  to  null  out  deviations  from  the  nominal  target  state.  This 
notation  is  required  to  differentiate  between  this  type  of  velocity 
correction  and  velocity  corrections  required  to  'achieve  an  altered 
target  state.  Linear  midcourse  guidance  policies  are  discussed  in 
more  detail  in  the  subroutine  GUIS  analysis  section. 


Subroutine  GUISIM  calls  GUIS  to  compute  the  guidance  matrix,  I\,  and 

the  target  condition  covariance  immediately  prior  to  the  guidance  event, 

W“,  and  then  uses  I\  to  compute  the  velocity  correction  covariance  S^,  which 

is  defined  as 
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S - E [AV  AV*  ], 
J j j 

and  is  given  by  the  equation 


’ rj(V 


- r, 


This  equation  assumes  that  an  optimal  estimation  algorithm  is  employed 
in  the  navigation  process,  since  the  derivation  of  this  equation  requires 
the  orthogonality  of  the  estimate  and  the  estimation  error. 


Since  state  estimates  5X  are  generated  in  the  simulation  program, 

A J 

an  actual  AV  can  always  be  computed.  This  is  in  contrast  to  the  error 

J A 

analysis  program  where  only  a statistical  or  effective  AV 


N 


can  be  computed. 


j 


The  perfect  velocity  correction  AV^ , defined  as  the  velocity  correction 

required  to  null  out  actual  deviations  from  the  nominal  target  state,  is 
also  computed  for  midcourse  guidance  events.  Assuming  linear  guidance 
theory,  the  perfect  velocity  correction  is  given  by 


AV  = r 5X. 
— j . J J 


where  dX.  is  the  actual  deviation  from  the  targeted  nominal.  An  option 

A 

is  also  available  in  GUISIM  for  re-computing  AV  using  nonlinear  techniques. 

j 

However,  it  should  be  noted  that  the  nonlinear  two- variable  B-plane  guidance 

policy,  unlike  the  corresponding  linear  policy,  constrains  the  z-component 

of  AV„  to  be  zero. 

N , 


If  planetary  quarantine  constraints  must  be  satisfied  at  a midcourse 
correction,  GUISIM  calls  BIAIM  to  compute  the  new  aimpoint  n.  and  the 

' A ^ 

bias  velocity  correction  AV_  . All  computations  in  BIAIM  are  based  on 

linear  guidance  theory.  However,  an  option  is  available  in  GUISIM  to  re- 
compute the  total  velocity  correction  AV^  + Av  , but  not  , using  non- 

o . N . i 

J j • 

linear  techniques.  This  option  is  recommended  if  a biased  aimpoint^guidance 
event  occurs  at  t = injection  time.  It  should  also  be  noted  that  Q.  is 


set  to  zero  If  t 


j 


= injection  time  since  it  is  assumed  that  the  injection 


GUISIM-5 


covariance  does  not  change  for  small  changes  In  injection  velocity. 


After  the  updated  control  covariance  Pc  has  been  computed,  the 

■I-  ^ 

target  condition  covariance  matrix  following  the  guidance  correction 
is  computed  using  the  equation 


where  variation  matrix  17.  has  been  previously  computed  in  subroutine 
GUIS. 


2.  Re-targeting. 

In  the  simulation  (and  error  analysis)  program  a re- targeting  event 
is  defined  to  be  the  computation  of  a velocity  correction  Av^,  required 

to  achieve  a new  set  of  target  conditions  using  nonlinear  techniques. 

'•V'  _ 

Since  the  state  estimate  X.  + 5X.  is  used  as  the  zero-th  iterate  in 

J J 

the  re- targeting  process,  the  new  target  conditions  must  be  close  enough 
to  the  original  nominal  target  conditions  to  ensure  a convergent  process. 

It  should  be  noted  that  after  a re-targeting  event  the  new  target 
conditions  are  henceforth  treated  as  the  nominal  target  conditions. 

3.  Orbital  insertion. 


An  orbital  insertion  event  is  divided  into  a decision  event  and  an  execution 

event.  At  a decision  event  the  orbital  insertion  velocity  correction  AV„ 

01 

and  the  time  interval  At  separating  decision  and  execution  are  computed 


based  on  the  state  estimate 


X + 6X . . 

j J 


The  relevant  equations  can  be 


found  in  the  subroutine  C0PINS  analysis  section  for  coplanar  orbital 
insertion;  in  N0PINS,  for  non-planar  orbital  insertion.  Before  returning 
to  the  basic  cycle,  GUISIM  schedules  the  orbital  insertion  execution  event 
to  occur  at  tj  + At  and  re-orders  the  necessary  event  arrays  accordingly. 


A At  an  orbital  insertion  execution  event  the  previously  computed 
AV~t  is  used  to  update  the  targeted  nominal  state. 

PI  A 


planeto- centric  equatorial  components  of  AV 


PI 


In  addition,  the 
and  the  actual  spacecraft 


cartesian  and  orbital  element  states  following  the  insertion  maneuver  are 
computed. 
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4.  Externally-supplied  velocity  correction. 


At  this 
updated 


A 


type  of  g 
using  the 


uidance  event  the  state  estimate  X.  4-  X. 

J J 

externally-supplied  velocity  correction 


is  simply 


Because  of  the  complexity  of  the  GUISIM  flow  chart,  a simplified 
flow  chart  depicting  the  main  elements  of  the  GUISIM  structure  precedes 
the  complete  GUISIM  flow  chart. 


GUISIM-8 


220 


Restore  state  vectors,  times.  Update  state  vectors,  times 
and  covariance  matrices.  and  covariance  matrices. 


GUISIM-9 
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GUISIM- 11 
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Compute  and  write  out  actual  and  estimated 
position/velocity  deviations  from  the 
targeted  nominal. 


Compute  and  write  out  the  commanded  and 
perfect  velocity  corrections  to  null  out 
errors  from  most  recent  target  conditions. 
Compute  and  write  out  the  error  in  the 
velocity  correction  due  to  navigation 
uncertainty. 


IGUID (3 , II)  = 0 ? 


Store  AVn  in  DVN  array  for  use  in 

J 

subroutine  BIAIM. 


tj  = injection  time? 


Call  BIAIM  to  perform  biased  aimpoint 
guidance  event.  Return  aimpoint  ^ , 

bias  velocity  correction  AV  ’ an<* 

J 

tv> 

execution  error  covariance  matrix  Q.. 

J 


^ - 
(9671 


GUISIM- 13 
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Call  N0NLIN  to  compute 
nonlinear  commanded  velocity 
correction.  Return  XDELV. 


\K 


Set  AVjjp  to  XDELV.  Compute 

^ /V 

magnitude.  Write  out  AVyp 
and  its  magnitude.  j 


Write:  Nonlinear 
guidance  failed. 
Linear  guidance 
will  be  employed. 


. = injection  time? 


Compute  Q.  using  AVup  . 

J urj 

Set  IRET  = 2 . 


(9S 


Write  out  correlation  matrix 
and  standard  deviations  assoc- 
iated with  ($ j . 


IRET  = ? 


Compute  and  write  out  eigen- 
values, eigenvectors,  and 
hyperellipsoid  associated  with 


Set  AVUP.  to  AVN  ' 
, J J 


IGUID(2,II) 


GUISIM-15 
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t.  = injection  time? 


|AVUP  .|  t 0 ? 
YES  r 


IGUID (1 , II)  f 4 or  5 ? 
NO 


Compute  and  write  out  planeto-centric 
equatorial  components  of  AV . . 


IGUID (4, II)  + 2 ? 


NO 


IGUID (1 ,11)  f 4 or  5 ? 
ES 


IGUID (1 ,11) > 4 ? 


GUIS IM- 17 


Compute  Julian  date  at  t j , 
Set  IG0  = 2 . 


Compute  target  condition  covariance 
matrix  W^"1"  following  the  guidance 

correction.  Write  out  the  associated 
correlation  matrix  and  standard 
deviations . 


Compute  and  write  out  eigenvalues, 
eigenvectors,  and  hyperellipsoid 
associated  with  W.  . ’ 

j - ZZ 

Compute  and  write  out  actual  target 
error  due  to  navigation  uncertainty, 
actual  target  error  due  to  execution 
error,  and  total  target  error. 


IGUID (5, II)  = ? 

(Is  velocity  correction  to  be  executed? 


Store  PSAVE  array  in  the  PI 
array  so  that  the  PI  array 
contains  the  knowledge  co- 
variance  just  before  the 
guidance  event. 


1,3  (YES) 


229 


GUISIM- 18 


230 


9761 


GUISIM-19 


231 


GUISIM-20 
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HELIO  Analysis 


HELIO  computes  the  zero  iterate  initial  state  for  interplanetary  trajectories. 
The  initial  and  final  states  are  determined  either  by  an  arbitrary  position 
vector  or  by  the  location  of  a specified  planet  at  a prescribed  time  according 
to 


IZERO  = 1 
2 

3 

4 


planet  to  planet 
planet  to  arbitrary  final  point 
arbitrary  initial  point  to  planet 
arbitrary  initial  point  to  final  point 


The  final  time  used  in  locating  a planet  must  correspond  to  the  closest 
approach  (CA)  to  the  planet.  Therefore  if  the  target  time  is  read  in  as 
a sphere  of  influence  (SOI)  time,  a modification  is  required.  The  helio- 
centric conic  is  computed  (as  described  below)  using  the  t time  to 

determine  the  final  position.  The  approach  asymptote  corresponding 

to  that  trajectory  is  used  with  the  desired  r^  to  compute  the  time  from 

SOI  to  CA.  If  r is  not  a target  variable  then  the  target  values  of  B-T 
CA 

and  B*R  are  used  to  estimate  the  r 

CA 


Then  the  approximate  approach  hyperbola  is  given  by 


a 


h 


Mr 


SI 


2 M 


V 2 r 
HP  SI 


e 

h 


P 


h 


a (i  - e 2) 
n h 


and  the  hyperbolic  time  to  go  from  SOI  to  CA  is  given  by 


At 


SICA 


H 

— ( e sinh  F - F) 
HP 


(2) 


(3) 


where 


HELIO-2 


tanh  — 


e - 1 
n 

e +1 
h 


tanh  — 


cos  f 


K? 


h_ 

SI 


(A) 


The  final  time  is  then  given  by  tf  “ CSI  + AtSICA  ‘ 

The  initial  and  final  positions  and  r of  the  heliocentric  conic 

i f 

are  either  input  or  computed  from  the  positions  of  planets  determined  by 
ORB  and  EPHEM.  The  unit  normal  to  the  heliocentric  orbit  plane  is 


tf  - All 


(5) 


r x r 
i f 


The  inclination  to  that  plane  is 


cos  i 


/ 

W 


(6) 


The  ascending  node  of  the  plane  is  given  by 

/\ 

W 

tan  = — - 

/\ 

-V 

y 


(7) 


The  central  angle  of  transfer  is  defined  by 


cos  'I'  = 


ri‘  rf 
rirf 


(8) 


The  semi-major  axis  a and  eccentricity  e of  the  heliocentric  conic  are 
computed  from  Lambert's  theorem  in  subroutine  FLITE.  The  true  anomaly  f 

at  the  initial  and  final  points  are  computed  from 

2> 


a (1  - e ) 
P " 


cos  f^  = 


sin  f 


e r. 


P-ri 

cos  f . cos  ^ - 

i e r 


sin  ^ 


(8) 
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f 


f 


f + * 


Finally,  the  argument  of  periapsis  u)  is  computed  from 


cos  (o>  + f ) = — — 

i r 

i 

where  "u'  = (cos  ft  , sin  fl  , 0)  . 


(10) 


Therefore  the  initial  or  final  states  ( Tr'  , aT.  ) or  ( "r  , "v"  ) may  now  be 

i i f f 

computed  by  ELCAR.  Let  ( ~r,  "v’  ) denote  either  state  and  let  ( ~r,  "v"  ) 

denote  the  state  of  the  relevant  planet.  The  departure  (or  approach) 
asymptote  is  then  given  by 


v 

HP 


The  latitude  and  longitude  of  the  position  vector  are 


(11) 


sin  0 


r 

r 


tan  0 


lx 


The  path  angle  T may  be  computed  from 

r 

cos  I = c— 


r v 


(12) 


(13) 


The  azimuth  of  the  relevant  state  is 


sin  2 


/\ 

( ~r  x v ) • U 


r x v 


cos  2 


V-U 

v cos  r 


(14) 


(15) 


If  the  initial  state  is  referenced  to  a planet,  subroutine  LAUNCH  is  called 
to  convert  the  departure  asymptote  and  launch  profile  into  an  injection 
radius,  velocity,  and  time.  Otherwise  the  initial  state  is  returned  as  the 
initial  state  on  the  heliocentric  conic. 


Reference:  Space  Research  Conic  Program,  Phase  III,  May  1,  1969,  Jet 

Propulsion  Laboratory,  Pasadena,  California. 
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HYELS  Analysis 

Subroutine  HYELS  computes  and  writes  out  hyperelliysoids  associated  with 
a 2 or  3 dimensional  covariance  matrix  P„ 


If  P is  assumed  to  be  the  covariance  matrix  of  an  n-dimensional  random 
variable  x having  a gaussian  distribution  with  mean  zero,  then  the  pro- 
bability density  function  is  given  by 

T 

r i - B-i  -i 

exp  - 2 x P x 


l ] raU2 

n/2  p | P | 1/2J 

shows  that  the  surface  of  constant  probability  density  p is  an  m-dimen- 
sional  ellipsoid,  where  m is  the  rank  of  P.  The  constant  k can  be  shown 
to  correspond  to  the  sigma  level  of  the  ellipsoid. 


P = 


(2^2IPI1/2 

Re-writing  this  equation  as 


-1  -» 

x P x = 2 In 


L (2 


For  n = 3,  the  above  equation  has  form 

'2  2 2 2 
ax  + by  + cz  +dxy+exz+fyz=k 


where 


a = a 


11 


d = 2a 


12 


b = a 


22 


e = 2a 


13 


c = a 


33 


f = 2a 


23 


and  the  a^  are  the  elements  of  P 


-1 


Subroutine  HYELS  uses  this  equation  to  compute  a 3-dimensional  hyperellip- 
soid, and  sets  the  appropriate  constants  to  zero  to  compute  a 2-dimensional 
hyperellipsoid. 


Reference:  H.  Sorenson.  "Kalman  Filtering",  Advances  in  Control  Systems, 

Vol.  3,  C.  T.  Leades  (Ed.).  New  York;  Academic  Press,  1966, 
P.  219. 
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IMPACT  Analysis 


The  impact  parameters  B*T  and  B*R  form  a convenient  set  of  variables 
for  the  description  of  the  approach  geometry  for  lunar  and  interplanetary 
missions.  Let  a reference  cartesian  coordinate  system  XYZ  (ecliptic  in 
STEAP)  be  established  at  the  center  of  the  target  body.  Let  Voo  denote 
the  hyperbolic  excess  velocity  of  the  spacecraft  in  the  XYZ  system.  An 
auxiliary  coordinate  system  R-S-T  may  be  constructed  relative  to  the  Voo 
by  the  definitions 


A 

S 


Voo  /voo 


A 

T 


A A 
S x K 


AAA 

R = S x T (1) 


A a. 

Therefore  S is  in  the  direction  of  the  approach  asymptote^  T lies  along 
the  intersection  of  the  impact  plane  (tne  plane  normal  to  S and  passing  t 
through  the  center  of  the  planet)  and  the  Reference  plane  (XY-plane) , and 
R completes  the  right  hand  system.  The  B vector  lies  in  the  impact 
plane  and  is  directed  to  the  incoming  asymptote.  Then  B*T  and  B*R  have 
the  usual  vector  definitions. 


A 

Z 


Figure  1.  Impact  Plane  Parameters 


In  the  optional  part  of  the  subroutine , the  target  impact  parameter  B* 
associated  with  5 and  a target  inclination  i (relative  to  target  planet 
equator)  and  radius  of  closest  approach  r^  is  computed.  However  given 

an  approach  asymptote  S there  are  generally  four  trajectories  with  the 
same  values  of  i and  r . °f  these  trajectories  are  retrograde  and 
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two  are  posigrade.  For  each  type  of  motion  therjj  are  two  distinct  planes 
that  have  tne  same  inclination  and  include  tne  S vector.  These  are 
distinguished  by  the  direction  of  motion  wnen  tne  approacn  asymptote  is 
crossed,  i.e.,  wnetner  the  motion  is  from  north  to  south  (northern  approacn) 
or  from  south  to  north  (southern  approach).  Let  0 £ cL  4:  90°.  Then 
setting  the  target  inclinations  to  tne  following  values  determines  the 
trajectory  which  will  be  specified: 


i 

Trajectory 

a 
- a 

180+  ct 
180-  a 

posigrade  with  northern  approach 
posigrade  with  southern  approach 
retrograde  with  northern  approach 
retrograde  with  southern  approach 

The  possible  trajectories  are  illustrated  in  Figure  2. 


Figure  2.  Possible  Trajectories  with  Same  Inclination 


The  detailed  computations  for  the  basic  part  of  the  program  are  straight- 
forward. Using  tne  standard  conic  abbreviations, 


c 


r x v 


(2) 


a r x v 
w * 

'■!  C 


(3) 


2-rvh 


(4) 

(5) 
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e « 1 - “2- 
a 

(6) 

b = V p j a | 

(7) 

cos  f = 

e r 

(8) 

sin  f 11  - 

efl 

(9) 

Z = £ v-ir 
c c 

(10) 

P «=  — cos  f - Z 
r 

sin  f 

(11) 

Q = — sin  f + Z 
r 

cos  f 

(12) 

's  = - a 'p 

+ b 

$ 

(13) 

V a2+b2 

V a2+b2 

q . S x K 

A A 

S x K 

(14) 

A A Z' 

R = S x T 

(15) 

— ,2  ^ 

B - “ P 

jl  ab 

A 

0 

(16) 

V a2+b2 

VaW 

A 

B »T  = B . T 

(17) 

_ i A 

B«R  = B - R 

(18) 

The  computations  for  the  optional  part_of  tne  program  which  converts 
the  i and  r^  into  an  equivalent  B*  proceed  as  follows.  The 

approach  asymptote  is  first  converted  into  target  planet  equatorial 
coordinates  and  its  right  ascension  and  declination  computed 
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A A 

Sq  = <t>  ECEQ  s 


-1  (Sq)v 
0_  = tan  — — -2. 

S (Sq)v 


<5g  » sin  1 (Sq) ^ 


(19) 


The  angle  Zl0  between  the  ascending  node  of  the  trajectory  and  the 
right  ascension  of  the  approach  asymptote  is  from  Napiers  rule 


tan  6 

sin  0 = 

tan  i 


(20) 


after  assuring  that  | i J 1 6 | . The  ascending  node  of  the  trajectory 
is  then  computed  recalling  the  definitions  of  the  angle  i 


Q » 0 + A9  C+7T) 

b 


(21) 


Thus  the  unit  vector  to  the  ascending  node  is  given  by 


«=  (cos  42,  sin  42,  0) 


(22) 


The  normal  to  the  orbital  plane  (in  target  planet  equatorial  coordinates) 
is 

A A 
A Sq  x L 

w - 7a 7T~  (23) 

q I Sq  x R 


This  is  now  converted  to  the  ecliptic  coordinate  system 

A T a 
wc-  »kchqh<> 

The  unit  vector  in  the  desired  B*  direction  is 


(24) 


A 

B* 


A.  A 

S x Wc 

A A 

S xW 


(25) 
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The  magnitude  of  the 


B* 


vector  is  given  by 


B*  = 


(26) 


Then  tne  target  impact  parameter  is  B*  = B*  B*  „ The  target  values  are 
then  given  by  their  obvious  definitions 

v A 

B-T*  « B*  - T 

— /s  (27) 

B*R*  ■ B*  • R 


Finally  the  hyperbolic  time  from  (r,  ”v)  to  periapsis  is  computed  from 
the  conic  formula 


tanh  — 


e 1 
e + 1 


t 


(e  sinh  F - F) 


(28) 


Reference:  Kizner,  W.,  A Method  of  Describing  Miss  Distances  for  Lunar 

and  Interplanetary  Trajectories,  Ballistic  Missiles  and 
Space  Technology  vol  III,  Pergamon  Press,  New  York,,  1961 „ 
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IMPCT  Analysis 

The  subroutine  IMPCT  is  responsible  for  computing  all. of  the 
target  parameter  data  associated  with  auxiliary  targeting.  Three 
basic  types  of  target  information  are  required  given  a planeto- 
centric  ecliptic  state.  First,  what  are  the  actual  B-plane  pierce 
point  coordinates,  B^-T  and  B^*R?  Second,  what  are  the  values  of 

the  actual  target  parameters?  These  may  be  triples  of  inclina- 
tion, radius  and  time  at  closest  approach  or  right  ascension, 
declination,  and  time  at  impact.  Third,  what  are  the  B-plane 
pierce  point  coordinates,  B^*T  and  B^-R  on  the  current  tra- 
jectory required  to  achieve  the  desired  values  of  the  corres- 
ponding actual  target  parameters.  In  addition  to  supplying  all 
of  this  information,  IMPCT  places  it  in  the  appropriate  loca- 
tions for  sorting  by  the  processing  routine  TAR0PT. 

Whenever  IMPCT  is  called,  it  first  calculates  the  actual  B-plane 
pierce  point  coordinates  for  the  current  state.  In  the  process 
it  also  calculates  other  useful  information  about  the  osculating 
conic,  including  the  parameters  a,  e,  6,  W,  S_,  T and  R.  For  the 
equations  giving  these  quantities  see  the  subroutine  STIMP  analy- 
sis. If  option  flag  K0PT  is  1,  only  this  information  is  desired 
and  a return  to  the  calling  program  is  executed. 

The  values  of  the  actual  target  parameters  are  calculated  if  K0PT 
is  not  1.  If  the  targets  are  inclination,  radius,  and  time  at 
closest  approach,  K0PT  must  be  2.  If  TARGET  is  not  in  the  second 
phase  of  a two-phase  targeting  case,  the  target  parameters,  i, 
rCA»  and  t ^ are  obtained  by  conic  extrapolation  from  the  current 

state  (SOI) : 


rCA  - a (1  - e)' 


(1) 


Let  D denote  the  transformation  from  planetocentric  ecliptic 
coordinates  to  the  planetocentric  equatorial  frame: 


i = cos'-1 


(2) 


If  TARGET  is  in  a second  phase,  the  virtual  mass  "program  will 
have  integrated  the  trajectory  all  the  way  to  closest  approach 
rather  than  stopping  at  the  SOI.  Hence  refined  values  of  all 
three  target  parameters  are  available  from  VMP . 
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Suppose,  on  the  other  hand,  that  the  targets  are  right  ascension 
a,  declination  6,  and  time  t at  impact.  Then  K0PT  must  be  3. 

Again  if  TARGET  is  not  involved  in  a second  phase,  these  target 
parameters  are  calculated  by  extrapolating  conically  from  the  SOI. 
Let  .r  and  denote  the  position  vectors  of  the  vehicle  at  im- 
pact in  the  planetocentric  ecliptic  and  probe-sphere  frames, 
respectively.  Let  C denote  the  transformation  from  the  former 
frame  to  the  latter.  Obviously 

P-X  " c£x*  (4) 

The  right  ascension  and  declination  at  impact  are  then 

a = tan“ 1 


and 

6 = sin^1 


Let  Atgc  and  At.^  be  the  times  from  the  sphere  of  influence  and 

from  the  probe  sphere  to  closest  approach,  respectively.  Let  0 ^ 

denote  the  true  anomaly  on  the  osculating  conic  at  the  probe 
sphere : 


JPl)2/(Pl)l]’ 

>vv 


cos  0I  = ^p/  rI  - 1/a)/  e (7) 

where 

p = a (1  - e2)  (8) 

is  the  semilatus  rectum  of  the  conic.  Since  impact  occurs  before 
peripsis, 

sin  = - J 1 - cos2  0j..  (9) 

With  the  true  anomalies  on  the  conic  at  the  current  state  and  at 
the  probe  sphere  available,  IMPCT  cals  HYPT  to  determine  At 

o L 

and  At^.  If,  as  above,  tg0I  denotes  the  time  from  the  sphere 
of  influence  to  periapsis, 

b ■ 'SOI  + Kc  ■ 4tic)  • <10) 


246-2 


IMPCT-3 


Finally,  if  TARGET  is  involved  in  the  second  phase  of  targeting, 
the  virtual-mass  algorithm  integrates  the  trajectory  all  the  way 
to  the  first  integration  increment  inside  the  probe  sphere.  Hence 
the  preceding  conic  extrapolation  formulae  can  be  used  to  obtain 
accurate  impact  target  parameters  by  replacing  the  state  at  the 
SOI  with  the  first  state  inside  the  probe  sphere. 

IMPCT  calculates  the  desired  B-plane  pierce  point  coordinates 

B *T  and  B *R  for  either  the  i and  r or  a and  B target  options 
U L) 

if  the  flag  ITARR  is  2 indicating  that  a new  control  iteration  is 
being  made.  The  equations  and  logical  flow  of  this  calculation 
for  the  former  target  option  is  given  in  the  subroutine  IMPACT 
while  tose  for  the  latter  are  presented  in  DIMPCP. 
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INSERS  Analysis 


INSERS  controls  the  processing  of  an  orbital  insertion  event.  The  sub- 
routine COPINS  and  NONINS  perform  the  actual  computations  for  the  co- 
planar  and  non-planar  options  respectively. 

INSERS  first  records  the  specific  parameter  values  for  the  current  orbit 
Insertion  event. 


It  then  computes  the  current  state  (r,  v)  of  the  spacecraft  in  target- 
planet  centered  ecliptic  coordinates.  Subroutine  PECEQ  is  called  to 
compute  the  transformation  matrix  ‘fcgggQ  from  ecliptic  to  equatorial 
coordinates.  The  planet  centered  equatorial  coordinates  are  then 


r 

q 


<f> 


ECEQ 


r 


v 

q 


* 

ECEQ 


v 


This  state  is  then  sqnt  to  COPINS  or  NONINS  for  the  computation  of  the 
insertion  velocity Av  and  the  time  interval  t between  the  current  time 
and  the  time  at  which^the  insertion  should  take  place . (based  on  conic 
propagation  about  the  target  body).  The  correction/\v  is  then  con- 
verted to  ecliptic  coordinates  ^ 

Av  =<I>T  Av 

q 


If  the  event  is  a compute-only  mode,  the  return  is  made  to  GIDANS. 

If  the  event  is  to  be  executed  the  flag  IEX  (set  by  COPINS  or  NONINS 
to  indicate  success  or  failure)  is  then  interrogated.  If  IEX  = 1, 
no  acceptable  insertion  event  was  found  and  so  the  executive  flag 
KWIT  is  set  to  1 before  returning.  If  IEX  = 0 an  acceptable  insertion 
was  determined  and  so  it  is  set  up. 


/ 
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INSERS  Flow  Chart 


RETURN 
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JACOBI  Analysis 


The  Jacobi  method  subjects  a real,  symmetric  matrix  A to  a sequence  of 
transformations  based  on  a rotation  matrix: 


cos 


s 


in  (j) 

K 


-sin  <f) 
cos  <$> 

K J 


where  all  other  elements  of  the  rotation  matrix  are  identical  with  the 
unit  matrix.  After  n multiplications  A is  transformed  into: 


A' 


A 0. 


0 


N 


If  0 is  chosen  at  each  step  to  make  a pair  of  off-diagonal  elements 
K 

zero,  then  A1  will  approach  diagonal  form  with  the  eigenvalues  on  the 
diagonal.  The  columns  of  0^  correspond  to  the  eigenvectors  of  A. 


The  angle  of  rotation  0 is  chosen  in  the  following  way.  If  the 
four  entries  of  0 are  in  (i,i),  (i,j),  (j,i)  and  (j,j)  then  the  corres- 
K - 1 

ponding  elements  of  0^  A 0 are 


ii 


2 2 
a. , cos  0 + 2a  ^ . sin  0 cos  0 + a sin  C 
ii  ij  JJ 


b^j  = b j ^ - a^-[)  sin  0 cos  0 + a^j(cos^0  - sin^0) 


b . . *=  a . . sin^0  - 2a . . sin  0 cos  0 + a . . cos^0 
JJ  ii  ij  JJ 


If  0 is  chosen  so  that  tan  20  = 2a.  ^ j / Ca  ^ ^ ~ a ) then 


b 


ij 


= 0 


Each  multiplication  creates  a new  pair  of  zeros  but  will  introduce  a non- 
zero contribution  to  positions  zeroed  ou^on  previous  steps.  However, 


successive  matrices  of  the  form 
required  diagonal  form. 


0 


-1  0-i 


A 0^  C>2  will  approach  the 


Reference : 


Scheid, 
Analys is 
1968. 


Frances:  Theory  and  Problems  of 

, McGraw-Hill  Book  Company,  Inc. 


Numerical 
New  York, 
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NO 


y * 

^Tl.LE.  F0D? 


YES 

Place  diagonal  from 

f ^ 

A into  W2 

L 


NO 


I 


T1  - T1  * 0.001 


RETURN 
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KTR0L  Analysis 

KTR0L  calculates  the  targeting  velocity  increment  Av  given  the 

T 

targeting  state  vector  X = (_r  /v)  of  the  spacecraft  relative 
to  the  launch  planet  and  the  launch-planetocentric  velocity  con- 
trols c^,  c^,  and  c^.  This  computation  is  required  in  two  dis- 
tinct situations.  The  first  is  in  calculating  the  sensitivity 
matrix  of  the  auxiliary  parameters  to  the  velocity  controls  by 
successively  perturbing  each  control  while  holding  the  remaining 
two  constant.  The  second  is  in  applying  the  control  correction 
indicated  by  the  Newton-Rap hs on  algorithm  to  arrive  at  the  next 
iterate  to  the  postimpulse  targeting  state. 

In  either  case  the  three  unit  vectors  _V,  IJ,  and  W that  serve  to 
define  the  local,  spherical,  velocity-control  coordinate  system 
are  first  computed  > 


V 

v = -=- 

(1) 

— V 

— x — 

- “ 1!  L x v II 

(2) 

U = W x v . 

(3) 

V specifies  the  direction  of  zero  latitude  and  zero  longitude 
in  the  control  frame  while  the  W axis  determines  the  +z  or  polar 
direction.  Then  c^  and  c^  are,  respectively,  the  latitude  and 

longitude  of  the  posttargeting  velocity  while  c^  is  the  increase 

in  length  of  that  velocity.  Figure  1 defines  the  controls  pic- 
torially  when  the  earth  is  the  launch  planet.  The  velocity  in- 
crements required  in  either  of  the  two  situations  mentioned  above 
can  readily  be  calculated  in  terms  of  the  vector  _V,  U,  and  W. 

First  consider  the  calculation  of  the  increment  Av^  produced  by 

perturbing  the  ith  control  an  amount  c^  while  fixing  the  other 

controls  at  zero  as  required  in  the  sensitivity  approximation. 
KTR0L  performs  this  conputation  when  IOPT  = i.  Reasoning  from 
Figure  1 it  follows  immediately  that 


o 

II 

rri 

31 

(4) 

Av^,  = j]  v |j  ^cos  c2  - 1 j V + sin  c2  U 

(5) 

Av^  = |J  v |j  |cos  c^  - 1 \ V + sin  c^  W. 

(6) 
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Figure  1 Pictorial  Definition  of  Launch- 
Planetocentric  Targeting  Controls 


Next  consider  the  calculation  of  the  increment  A_v  produced  by 
perburbing  all  three  controls  simultaneously  as  required  in  the 
Newton-Raphson  control  correction.  KTR0L  performs  this  computa- 
tion when  I0PT  = 4.  Reasoning  again  from  Figure  1 


Av 


+ CjJ  COS  C£  cos  C3 


V 


+ ^||  v j + c^j'  sin  cos  c3  U + (|  v|  + c^ jsin  c^  W.  (7) 


Note  that  equation  (7)  degenerates  to  equations  (4) , (5) , and  (6) 
when  the  appropriate  controls  are  set  to  zero. 
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KTR0L  Flow  Chart 
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LAUNCH  Analysis 


LAUNCH  computes  the  injection  time,  position  and  velocity  from  the 
departure  velocity  ~v*  (computed  in  HELIO)  and  the  launch  profile  par- 

ameters  input  by  the  user. 

The  rotation  matrix  defining  the  transformation  from  ecliptic  to 

ECEQ 

equatorial  coordinates  is  first  computed  (PECEQ) . The  departure  velocity 

v is  then  normalized  and  converted  into  ecliptic  coordinates  to  yield 
HE  /\ 

the  departure  asymptote  S . 


's' 


ECEQ 


VHE 

v 

HE 


(1) 


Auxiliary  information  associated  with  S is  then  computed.  The  energy 
C^,  the  declination  <J>g  and  the  right  ascension  9g  of  the  departure 

asymptote,  and  the  eccentricity  of  the  departure  hyperbola  are  given  by 


C 


3 


HE 


2 


sin  <i>„  = S 

S z 

S 

tan  0 = -1 

S S 

x 


e 


1 


(2) 


where  r^  is  the  desired  parking  orbit  radius  and  m 
constant  of  the  launch  planet. 


is  the  gravitational 


The  unit  normal  W to  the  launch  plane  in  equatorial  coordinates  is  then 
computed.  W is  defined  by 


W = cos  <J>  sin  2t 
z L L 


W 


w 


-W  S S + kS  | 1 
z y z x 


[l  - <,*♦*] 


2 2 

S + S 
x y 

(W  S W S ) 
y y 4-  z z 


(3) 
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where  4>  is  the  launch  site  latitude,  2 is  the  launch  azimuth, 

L L 

and  k “ +1  or  -1  for  the  long  or  short  coast  time  models  respectively. 

The  second  equation  defines  an  implicit  constraint  on  2^ 


sin  2 < 

L 


cos  <& 


cos  <J> 


(4) 


The  right  ascension  at  launch  0 may  now  be  defined  by 

L 


cos  0 


W sin  * sin  2,  + W cos  2, 
x L L y L 


W 


sin  0 = 

L 


W sin  <f>T  sin  2T  - W cos  2. 
y L L x L 

W2  - 1 
z 


(5) 


and  the  unit  veptor  toward  the  launch  position  is  then 

= (cos  <3^  cos  0L  , cos  sin  0^  , sin  <I>^) 


(6) 


/\  /\ 

The  complementary  unit  vectors  P,  Q defining  the  orientation  of  the 
hyperbola  within  the  launch  plane  are  now  introduced.  Let 


B 


/\  /\ 
S x W 


(7) 


1 

The  true  anomaly  of  the  departure  asymptote  is  cos  f = - — . Then  P and 

/\  s e 
Q are  given  as 


/V  /\  /\ 

P *=  S cos  f + B sin  f 

s s 

/\  /\  /\ 

Q = Ssinf  * B cos  f 

s s 


(8) 


The  true  anomaly  of  the  launch  site  f^  may  now  be  given 


/N 

/\ 

cos  f 

JL 

* *t 

♦ P 

sin  f 

/\ 

/\ 

= R 

• Q 

L 

L 

between 

launch 

and 

(9) 


2"  " fL+  fI 


(10) 
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where  f^.  is  the  desired  true  anomaly  at  injection  read  in  as  input. 
The  coast  time  tc  may  now  be  computed  from 


'*'-(❖  + ♦ ) 
B l 2 


an 


where  and  are  the  angles  of  the  first  and  second  burns  and 

1 2 

k.  is  the  inverse  of  the  parking  orbit  coast  rate,  all  of  which  are 
read  in  as  input. 

The  time  between  launch  and  injection  is  therefore 

t„  - tx  + t2  + tc  (12) 


'B 


where  t and  t are  the  input  time  durations  of  the  first  and  second 
burns . 

The  unit  vector  to  injection  is 


/\  /\  /\ 

R.  = P cos  f + Q sin  f 
I II 


(13) 


The  semi-latus  rectum  p is 


S 


(14) 


The  radius  magnitude  to  injection  is 


*i  ' TT 


e cos  f 


(15) 


The  injection  speed  is 


-V 


C + 

3 R 


(16) 


The  path  angle  at  injection  is 

Vmp 


cos  r 


1 RIVI 


(17) 
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The  injection  latitude  is 


sin 


/\ 

R, 


The  injection  right  ascension  is 


tan  Q 


The  injection  longitude  is 
9 


9+0 
L I 


0 - CJt 

L B 


where  9 is  the  longitude  of  the  launch  site  and  U)  is  the 
L 

of  the  launch  planet,  both  being  read  in  as  input. 


The  injection  azimuth  is 


cos  2 = 


S - cos  (f  - f ) sin 
z s I 

sin  (f^  - f^.)  cos  ^ 


The  launch  time  on  the  day  of  launch  is 

(0  - 9 - GHA)  mod  2tt 

L L 


60 


where  GHA  is  the  Greenwich  hour  angle  at  0 UT  of  the  launch 

GHA  = 100?0 7554260  + 0?9856473460  T + 2?9015  x 101”3 

d 

where  T^  = days  past  0^  January  1,  1950. 


The  injection  radius  vector  is  now  computed  from 

\ 


/\ 

Rx  = RiR- 


^1 

*1 


( W x R ) cos  T + R sin  F 
I ' II  I 


The  injection  time  is 


T + t + t 
o L B 
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(18) 


(19) 


(20) 

rotation  rate 


(21) 


(22) 

date 

Td3  (23) 


(24) 


(25) 
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where  T is  the  Julian  date  of  the  launch  calendar  date, 
o 

The  injection  position  and  velocity  are  now  rotated  into  the  ecliptic 
plane.  The  position  and  velocity  of  the  launch  planet  at  the  time  T^  are 

computed  and  added  to  the  injection  state  to  get  the  heliocentric  injection 
state . 


Reference:  Space  Research  Conic  Program,  Phase  III,  May  1,  1969,  Jet 

Propulsion  Laboratory,  Pasadena,  California. 
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LUNA  Analysis 

LUNA  is  the  controlling  subroutine  for  lunar  zero  iterate  targeting.  It 
first  serves  an  interface  role  in  which  it  initializes  constants  and 
renames  variables  for  the  other  lunar  targeting  routines.  It  then  calls 
LUNTAR  for  the  targeting  of  the  lunar  patched  conic.  When  that  is  com- 
pleted it  calls  MULTAR  for  the  targeting  of  the  nulti  conic  trajectory. 
It  then  returns  control  to  PRELIM. 


LUNA  Flow  Chart 
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LUNCON  Analysis 


The  point  of  intersection  of  the  Earth-centered  conic  with  the  lunar 
sphere  of  influence  (LSI)  is  determined  by  the  angles  and  6. 

Relative  to  the  moon  in  Earth- equatorial  coordinates  tnat  point  is 


cos<5  cos  0 
cos  £ sin  0 
sin  <5 


(1) 


where  RCT  is  the  radius  of  the  LSI.  Relative  to  the  earth  that  point  is 
O X 

\ - \ + r7i  <2> 


where  Rm  is  the  radius  vector  to  the  center  of  the  moon  at  the  time  of 
LSI  intersection  tg^  in  earth  equatorial  coordinates. 


There  are  at  most  two  planes  which  contain  R^  and  satisfy  tne  launch 

latitude  0 and  azimuth  X constraints.  Let  ^ denote  the  unit  normal 
to  either  of  these  planes.  Now  let  V «L  , 0^  denote  the  unit  vector, 

longitude,  and  latitude  of  the  launch  site.  Construct  a local  horizon 
coordinate  system  at  the  launch  site  as  indicated  in  Figure  1. 


LUNCON- 2 


/\  Kir  A A A A .AAA 

Here  Z = — , is  normal  to  in  the  Z-O-R^  plane,  and  x Z^. 

h \ 

In  the  local  horizon  system,  the  position  and  velocity  are  very  simply 
represented 

K - » G>.  o,  D 1 

T 

V,  “ v[cos5  sinX  , cos  a cos  X , sinj] 


(3) 


where  X is  the  launch  azimuth  and  § is  the  declination  wrt  the  local 
horizontal.  Thus 


« . V * \ 
h \K*K 


-cosX 
sin  X 
0 


(4) 


The  transformation  matrix  converting  a vector  in  the  local  horizon  system 
to  the  equatorial  system  is 


-sin 


■sm  0 cos  9 
JL  Xj 


cos  0T  -sin  0_  cos 


cos  0, 


cos  0 cos  9 

Xj  Li 

cos  0L  sin  0^ 


sin  0. 


(5) 


Therefore  since  = T , the  z-component  of  W in  the  equatorial 
coordinate  system  is 


a 


W 


2 = cos  0^  sinX 


(6) 


A A A A 

Since  W is  a unit  normal  it  must  satisfy  both  W*W  = 1 and  W'S  = 0 


where  S = —9- 

R 

q 

A 

w 


Solving  for  the  two  remaining  components  of  W, 


aaa  a ,a9  a 2 . 

-W  S S + S \ 1 - (S  + W ) 
z y_  z — x M z z 


(7) 


S*+  s2 

x y 


X 


} s + w s ) 
y y ~ " 


z z 


(8) 


x 


To  eliminate  the  ambiguity  of  sign  in  (7)  the  short-coast  plane  corresponding 
to  the  negative  sign  is  used.  Note  that  (7)  also  imposes  a constraint  on 
the  launch  azimuth 
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A2 

„ 1 - s 

sin2i:  ^ 

cos  0 

L 


(9) 


Now  choose  U <=  W x S to  complete  a right  hand  system  (& , U,  W)  . Then 
the  position  at  LSI  relative  to  the  earth  is  (R^. , 0,  0).  Now  let  02 

determine  the  perigee  pointAin  the  orbital  plane  (Jw  = 0)  measured 
counterclockwise  from  the  -S  axis.  Then  the  perigee  point  is  (-r  coso, 

-r  sin  a , 0)  where  r^  is  the  parking  orbit  radius  (input).  Therefore 

the  true  anomaly  of  the  earth  centered  conic  at  the  LSI  is  given  by 


fgI  - 180  - a 


The  two  equations 


a(l  - e2) 

1 + e cos  f 

o i 


(10) 


and  r = a(l  - e)  may  be 
P 


solved  simultaneously  for  the  semi-major  axis  a and  eccentricity  e 
of  the  unique  earth  centered  conic 


e 

g 


RI  cos  fSI 


a 


g 


(ID 


(12) 


Thus  the  velocity  of  the  earth  centered  conic  at  the  LSI  is  in  the 

■A  /V  /V 

(S,  U,  W)  system 


>T 


a(l-e  ) e sin  f 


SI 


^a(l-e/)  / R7 


L o 


(13) 


Transforming  to  the  earth  equatorial  coordinate  system 


U 


W 


U, 


w. 


u 


w 


(14) 


260 


LUNCON-4 


Now  if  (Fj^q , Vj^q)  are  the  position  and  velocity  of  the  moon  at  t 
Earth-centered  coordinates  and  (Rq,  Vq)  are  the  position  and  velocity  of 
the  spacecraft  at  tgj  then  tne  state  of  the  spacecraft  with  respect  to 
the  moon  at  tg^.  is  in  earth  equatorial  coordinates 


SI 


RQ  “ % 


SI 


Q MQ 


(15) 


Using  the  transformation  matrix  0 defining  transformations  from 

earth  equatorial  to  lunar  equatorial  the  state  in  the  I/)  system  is 


rsq  = ^EQLQ  rSI 
Vsq  = ^EQLQ  VSI 


(16) 


The  impact  plane  parameters  B*T  and  B'R,  and  the  inclination  i 
may  now  be  computed  by  calling  subroutines  ACTB  and  CAREL.  ^ 
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LUNTAR  Analysis 


LUNTAR  generates  a patched  conic  trajectory  arriving  at  closest  approach 
to  ghe  Moon  at  a specified  time  tCA  and  meeting  prescribed  target 

values  at  that  point  as  well  as  standard  launch  quantities.  The  target 
parameters  are 


CA 


CA 


CA 

1CA 


Julian  date  of  required  closest  approach  (CA) 
referenced  1900 
Radius  of  CA 

Inclination  (relative  to  lunar  equator)  at  CA-1 
Semi-major  axis  at  CA 


The  launch  parameters 

0 Launch  site  latitude 

*L 

9 Launch  site  longitude 

Xj 

£ Launch  azimuth  (nominally  set  to  90°) 

L 

r Parking  orbit  radius 

P 

The  eccentricity  of  the  moon-centered  hyperbola  may  be  computed 


CA 


1 - 


~CA 

1CA 


(1) 


where  a <0.  The  hyperbolic  time  4t  to  go  from  R (radius  of  lunar 
CA  SI 

sphere  of  influence  (LSI))  to  periapsis  may  be  computed  from 


At  = f(V  aCA ’ eCA>  RSI> 


(2) 


where  fi is  the  lunar  gravitational  constant.  The  time  at  which  the 
probe  should  intersect  the  LSI  is  then 


SI 


t - At 
CA 


(3) 


The  inclination  must  be  specified  according  to  the  format  described  in 
IMPACT.  For  0 5Li<90°  the  inclinations  +i  prescribe  posigrade  orbits 
while  180  +i  define  retrograde  orbits.  The  positive  signs  denote  approaches 
from  the  north,  the  negative  signs  designate  southern  approaches. 
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The  position  R^g  and  velocity  VME  of  the  moon  at  tgI  relative  to  the 

earth  in  earth  ecliptic  (EC)  coordinates  are  computed  by  calling  ORB  and 
EPHEM.  Transformation  matrices  and  Pjjqlq  defining  transformations 

from  EC  to  EQ  (earth  equatorial)  and  EQ  to  IQ  (lunar  equatorial)  respectively 
are  then  computed  by  PECEQ.  The  position  and  velocity  of  the  moon  in  the 
EQ  system  are 


R = 0 R 

MQ  ECEQ  ME 

V*  ■=  "0  *V" 

MQ  ^ECEQ  ME 


(4) 


Call  the  point  of  intersection  of  the  vector  R^  with  the  LSI  the  bullseye 

point.  Then  in  moon-centered  Earth-equatorial  coordinates  the  vector  to 
the  bullseye  point  is  given  by 


(5) 


From  this  vector  one  can  calculate  a set  of  angular  coordinates  ( (>  , 9 ) 

o o 

of  the  bullseye  point.  Any  other  point  on  the  LSI  is  determined  by  giving 
general  coordinates  ( <5,  9)  = ( <5q  +4<5,  9q  + -49). 


Now  let  such  a set  of  coordinates  by  given.  They  determine  a vector  R 

I 

from  earth  to  the  LSI  (in  the  EQ- system).  The  vector  R^.  along  with  the 
launch  parameters  0^,  9^,  then  determines  the  plane  of  the  Earth-LSI 


transfer  (see  LUNCON) . Now  let  ot  be  measured  counter-clockwise  in  that 
plane  from  -Rp  The  parameter  a specifies  the  location  of  the  perigee 

point  of  the  transfer  conic,  thus  the  vector  to  perigee  is  fixed  as  "r* 

P 

where  the  perigee  magnitude  r is  fixed  as  input.  The  vectors  f*-  and 
_ P P 

R then  determine  a unique  conic  for  tne  Earth-LSI  phase  (see  LUNCON). 

Let  the  state  at  the  LSI  on  that  conic  (relative  to  Earth-equatorial  coordin- 
ates) be  denoted  by  Bp  if  . The  state  relative  to  the  moon  may  then  be 

computed  as 


(6) 
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Figure  1. 


Lunar  Patched  Conic  Targeting 


Thus  the  elements  relative  to  the  moon  may  be  computed  from  standard  conic 
formula.  The  three  angles  ( <5 , 9,  a)  form  a set  of  independent  controls 
to  be  varied  to  meet  the  three  constraints  (r^,  icA»  aCA^  • The  controls 

are  depicted  in  Figure  1. 

LUNTAR  uses  the  standard  Newton- Raphs on  algorithm  to  refine  the  controls  to 
meet  the  constraints.  This  targeting  is  done  in  two  stages.  In  the  first 
stage  the  controls  <5  and  9 are  held  fixed  at  the  bull?  eye  point  ( 6q,  9^) 

while  d is  varied  until  the  semi-major  axis  target  a is  met.  Then 

all  three  controls  are  varied  to  satisfy  the  three  target  constraints.  The 
preliminary  targeting  of  a is  essential  to  the  success  of  the  procedure. 

Once  the  in  initial  targeting  is  completed,  the  semi  major  axis  of  future 


LUNTAR-4 


iterations  in  the  second  stage  will  not  vary  much  from  the  target  value 

a For  such  iterates  the  excess  hyperbolic  velocity  at  the  moon  will  be 
CA 

generally  constant.  This  permits  toe  substitution  of  the  auxiliary  impact 

plane  parameters  B*T  and  B*R  for  the  less  linear  parameters  of  r and 

CA 

(see  IMPACT).  In  LUNTAR  the  impact  plane  parameters  are  referenced  to 
the  LQ  system. 


The  procedure  may  now  be  described  in  detail.  Suppose  tnat  in  the  first 

stage  of  targeting  the  current  value  of  ct  is  ct  . Using  the  controls 

K. 

(ot.,,  <5_,  9 ) the  resulting  semi-major  axis  is  found  to  be  a (LUNCON) . 

& 0 0 K 

A perturbed  value  for  the  first  control  is  then  used  (ot^  +4°*,  <5q»  9^) 
producing  a perturbed  value  of  semi-major  axis  (a^  + 4a).  The  (k+l)st 
value  of  ct  is  then  given  by  the  standard  numerical  differencing  approximation 


ct 


K+l 


= ot 


K 


Act 

A a 


(a 


CA 


V 


(7) 


The  second  stage  of  the  targeting  of  the  lunar  patched  conic  uses  the 

vector  analogue  of  the  above  procedure.  The  current  iterate  ( ct  ,6  >9 

K K K 

is  input  to  LUNCON  to  obtain  the  current  target  values  (a  , B-T  , B*R  ). 

K K K 


The  target  values  B*T  and  B*R  are  determined  from  subroutine  IMPACT 

and  the  errors  of  the  kth  iterate  are  computed  (e  , e e ).  If  all 

a BI  BR 

three  errors  are  within  tolerances,  the  procedure  is  terminated.  Other- 
wise the  sensitivity  matrix  0 is  computed  by  numerical  differencing  as 
in  the  first  stage 


) 


4act 

Azk 

Act 

A6 

49 

4b*t 

ct 

4b*Tj 

4b-T 

9 

Act 

Ad 

49 

dK.Ra 

AB'Rfi 

/JB-Rg 

Act 

A6 

49 

The  inverse  of  0 is  the  targeting  matrix.  The  k+l 
to  be 


(8) 


iterate  is  then  defined 
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This  procedure  is  repeated  until  convergence  is  achieved. 
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MEAN  Analysis 


Subroutine  MEAN  propagates  and  updates  actual  estimation  error 
means  over  the  time  interval  [t^*  t^^]  separating  two  successive 

measurements  or  events.  The  equations  programmed  in  MEAN  are  in- 
dependent of  the  filter  algorithm  employed  to  generate  gain  ma- 
trices. Gain  matrices  are  assumed  to  have  been  computed  during  a 
prior  call  to  subroutine  GNAVM.  The  propagation  equations  pro- 
grammed in  MEAN  are  also  used  to  propagate  actual  deviation  means 
over  the  time  interval  separating  two  successive  guidance  events. 
The  update  equations,  of  course,  are  not  used  in  this  situation. 


The  actualestimation  errors  for  position/velocity  state,  solve-for 
parameters,  dynamic  consider  parameters,  measurement  consider  param- 
eters, and  ignore  parameters  are  defined,  respectively,  by  the 
following: 

\ 


*k+l  *k+l  *k+l 


(1) 


X 


= it 


- x 


Sk+1  sk+l  Sk+1 


(2) 


\+l  \+l  \+l  Uo 


V.  , , = 0.  . . - V.  , - = - V 
k+1  k+1  k+1  o 


W = — w = — w 

k+1  k+1  k+1  o 


(3) 

(4) 

(5) 


where  (~)  indicates  estimated  values,  and  x,  x , u , v , and  w 

s o o o 

are  the  actual  deviations  from  nominal. 


Only  the  means  of  x and  xg  are  paopagated  and  updated  since  the 

me^ns  of  y,  x,  and  w are  constant.  The  propagation  equations  are 
summarized 


(6) 

(7) 


where  0 , 

xx 

s 


[tk’  fck+l] 


0 , and  0 are  state  transition  matrices  over 

xu  xw 
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Before  the  means  of  x and  xg  can  be  updated  at  a measurement,  the 
mean  of  the  measurement  residual  must  first  be  computed  using 

E[£k+l]  = - H • E[*k+l]  - M • E[\+1]  + G“o  + L%  + N”o  (8) 

where  H,  M,  G,  L,  and  N are  observation  matrix  partitions. 

The  update  equations  are  summarized  as: 


E[*k+i]  * E[\+i]  + \+i  • 

E[<+J  ' E[\ J + Vi 


where  K.  in  and  S.  are  the  filter  gain  matrices. 
k+1  k+1 

To  propagate  actual  deviation  means  requires  that  x and  xg  be 
replaced  by  x and  xg , respectively,  in  equations  (6)  and  (7),  and 
that  the  minus  signs  in  equations  (6)  be  replaced  with  plus  signs. 
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MEAN  Flow  Chart 


Estimation 
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MEN0  Analysis 

The  linearized  observation  equation  employed  by  the  navigation 
process  is  given  by 

< + \ 

where  6Y,  is  the  measurement  deviation  from  the  nominal  measure- 

Ak  A 

ment,  is  the  augmented  observation  matrix,  6X^  is  the  augmented 

state  deviation  from  the  nominal  augmented  state,  and  is  the 
assumed  measurement  noise. 

The  function  of  subroutine  MEN0  is  to  compute  the  assumed  measure- 
ment noise  covariance  matrix 


\ - E[\  \] 

if  IC0DE  = 0.  The  constant  measurement  noise  variances  associated 
with  all  available  measurement  types  are  stored  in  the  vector  MNCN. 
Subroutine  MEN0  selects  the  appropriate  element  from  this  vector 
to  construct  R . 


If  IC0DE  ^ 0 the  actual  measurement  noise  covariance  matrix 

K - E["k  nkT] 

where  n/  is  the  actual  measurement  noise,  is  computed  instead.  In 

K, 

this  case  subroutine  MEN0  selects  the  appropriate  actual  measure- 
ment noise  variances  from  the  vector  GMNCN  to  construct  R^. 

The  accompanying  flow  chart  indicates  the  computational  flow  for 
computing  R,  . An  identical  procedure  is  used  to  compute  R/. 
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MENO  Flow  Chart 
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k 
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RETURN 


Compute  the  matrix 

for  a range-rate  meas- 
urement from  the 
appropriate  station. 


Compute  the  R^  matrix 

for  a range  and  range- 
rate  measurement  from 
the  appropriate  station. 


I 


11,12,13 


Compute  the  R^  matrix 

for  the  appropriate 
star- plane  angle  meas- 
urement . 


Compute  the  R^  matrix 

for  an  apparent  planet 
diameter  measurement. 
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MEN0S  Analysis 


The  linearized  observation  equation  employed  by  the  navigation  process  is 
given  by 

K ■ 6\k  * »k 

A 

where  is  the  measurement  deviation  from  the  nominal  measurement, 

» A 

is  the  augmented  observation  matrix,  OX  is  the  augmented  state  deviation 

iV 

from  the  nominal  augmented  state,  and  Tj  is  the  assumed  measurement  noise. 

k 

The  actual  measurement  is  given  by 


-k 


+ b 


where  Y,  is  the  ideal  measurement,  which  would  be  made  in  the  absence  of 
— k 

instrumentation  errors,  b^  is  the  actual  measurement  bias,  and  V k 
represents  the  actual  measurement  noise. 


Subroutine  MENOS  performs  two  functions.  It's  first  function,  which  is 
identical  to  that  of  subroutine  MENO,  is  to  compute  the  measurement  noise 
covariance  matrix  R^  which  describes  the  statistics  of  noise  Y] t . The 


'k* 


constant  variances  for  the  assumed  measurement  noises  associated  with  all 

available  measurement  devices  are  stored  in  the  vector  MNCN.  Subroutine 

MENOS  selects  the  appropriate  elements  from  this  vector  to  construct  the 

measurement  noise  covariance  matrix  R.  . 

k 


The  second  function  of  MENOS  is  to  compute  the  measurement  noise  covariance 
matrix  R^  which  describes  the  statistics  of  the  actual  noise  The 

constant  variances  for  the  actual  measurement  noises  associated  with  all 

available  measurement  devices  are  stored  in  the  vector  AVARM.  Subroutine 

AVARM  selects  the  appropriate  elements  from  this  vector  to  construct  the 

measurement  noise  covariance  matrix  R,  . 

~k 
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MEN0S  Flow  Chart 


ENTER 


Compute  R^.  See 

MEN0  flow  chart 
for  details. 


r 

A 

[ 

RETURN 

V 

J 

Compute  the  R^  matrix 

for  3 star-planet 
angle  measurements. 


18  \ or  4 

to  be  computed? 


MMC0DE  = ? 


RETURN 


10,11,12,13 
1,2, 3, 4, 5, 6, 7, 8 


MMC0DE  even? 


RETURN 


Compute  the  R^  matrix 

for  a range-rate  meas- 
urement from  the 
appropriate  station. 


Compute  the  R^  matrix 

for  a range  and  range- 
rate  measurement  from 
the  appropriate  sta- 
tion . 


11,12,13 


Compute  the  matri: 

for  the  appropriate 
star-planet  angle 
measurement. 


RETURN 


Compute  the  R^  matrix 

for  an  apparent  planet 
diameter  measurement. 


RETURN 
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MINI Q Analysis 

Subroutine  MINIQ  computes  the  execution  error  covariance  matrix  and 
the  actual  execution  error . associated  with  the  spin-release  of  a 
miniprobe.  The  actual  execution  error  is  computed  only  when  MINIQ 
is  used  in  the  simulation  program  SIMUL. 

The  velocity  increment  imparted  to  the  ith  probe  at  release  is 
given  by 

AV1  = u x t1  (1) 


where  w is  the  spin  vector  and  it1  denotes  the  position  of  the  ith 
probe  relative  to  the  primary  vehicle.  Referred  to  the  u v h co- 
cordinate  system,  which  is  defined  in  subroutine  TPRTRG,  equation 
(1)  becomes 


AV1  = Z a)  cos 


* + (1-D 


2it_ 

3 


Q + sin 


4>  + (i-1) 


2tt 


(2) 


where 


<P  + (i-1) 


2ir 


is  the  roll  release  angle  of  the  ith  probe. 


and  u and  $ are  unit  vectors. 


Define  p = (u>,  Z„  a,  6,  <J>)  as  the  release  execution  parameter  vec- 
tor, where  oj  is  the  spin  rate  magnitude,  Z is  the  boom  length, 
a is  the  right  ascension  of  the  spin  axis,  6 is  the  declination  of 
the  spin  axis,  and  $ is  the  roll  release  angle.  Then  the  release 
execution  error  can  be  written  as 


5; 

3p 


(3) 


where  6p  represents  the  error  in  the  release  parameter  vector. 
The  jth  component  of  6AV  is  given  by 


5 


3AV* 

1 

3p 

*m 


(4) 
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The  execution  error  covariance  matrix  is  defined  as 

, T 


Q1  = E 


-H 

6AV  • 6AV 


and  the  element  Q*  of  matrix  Q1  is  given  by 

jit 


(5) 


'jk 


5 3AV" 

S.  3p 

m=l  m 


<$P. 


m 


5 3AV. 
V * 

H 3p 
n=l  *n 


6p 


n 


(6) 


Assuming  E 


6 6 

P P 
m rn 


= 0 for  m ^ n,  equation  (6)  reduces  to 


Q1 


5 3AVT  3AV" 

r*  i i 


jk 


i 3P 
m=l  m 


3P. 


6P. 


m 


(7) 


The  partial  derivatives  required  for  evaluation  of  equations  (4) 
and  (7)  are  summarized  as: 


SA^1 

3uj 


= 2 < cos 


<P  + (i-1) 


2 7T 


G + sin 


<J>  + (i-1) 


2tt 


v 


(8) 


jSA^1 

32. 


= 0)  <cos 


<p  + (i-1)  ~ u + sin 


<P  + (i-D  J- 


v 


(9) 


-►i 

3AV 

3a 


= 2u>  < cos 


+ (i-1)  ~ 


3u 

3a 


+ sin 


+ (i-1)  I1 


9v 

3a 


(10) 


3AV 

36 

3A\fX 

dip 


2 u ( cos 


* + (i-1) 


2tt 


3u 

36 


+ sin 


$ + (i-1) 


2tt 


3v  | 
36  I 


= 2oo  < — sin 


<P  + (i-1)  ~ 


u + cos 


2n 


(ID 


0 + (i-1)  — v)  (12) 
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where 


when 


u = (sin  a,  - cos  a,  0) 

v = (sin  6 cos  a,  sin  6 sin  a,  - cos  6) 
3 u 

" (cos  a,  sin  a,  0) 

A 

— » (-  sin  6 sin  a,  sin  6 cos  a,  0) 

a Ot 


3u 

86 

8v 

86 

referred 


= (0,  09  0) 

= (cos  6 cos  a, 
to  the  ecliptic 


cos  6 sin  a,  sin  6) 
coordinate  system. 


(13) 

(14) 

(15) 

(16) 

(17) 

(18) 
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M0MENT  Analysis 

T 

Subroutine  M0MENT  transforms  an  arbitrary  2nd  moment  matrix  E[xy  ] 
into  a correlation  matrix  and,  if  x ° y,  into  a vector  of  standard 
deviations.  The  transformation  consists  of  two  steps: 

T 

1)  Transform  E[xy  ] into  the  covariance  matrix 

T T 

cov  (x,y)  = E[xy  ] - E[x]  • E[y  ]; 


2)  Transform  cov  (x,y)  into  the  correlation  matrix  having 
correlation  coefficients 


P 


ij 


i i J 


where 


a.  = Efxf]*5 

x i 

“a  = ^ 


Subroutine  M0MENT  writes  out  the  correlation  matrix  and,  if  they 
exist,  the  standard  deviations.  Subroutine  M0MENT  can  also  compute 
and  write  out  the  eigenvalues,  eigenvectors,  and  hyperellipsoid 
of  cov  (x,y)  if  x = y. 
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MPPR0P  Analysis 

MPPR0P  serves  the  single  purpose  of  providing  a time  history  of 
the  targeted  main  probe  trajectory  from  release  to  the  appropri- 
ate stopping  condition.  The  process  of  providing  such  a time 
history  is  classified  as  a separate  type  of  guidance  event  in 
the  GIDANS  execution  logic.  Although  the  main  probe  propagation 
event  is  currently  only  applied  in  the  N0MNAL  program  to  propa- 
gate the  main  probe  once  it  begins  to  deviate  from  the  bus 
trajectory  due  to  some  guidance  maneuver  on  the  latter,  it  could 
be  used  to  treat  any  branched  trajectory. 

On  being  called  by  GIDANS,  MPPR0P  first  prints  out  the  title 
"Main  Probe  Propagation  Event"  followed  by  the  heading  "Main 
Probe  Approach  Trajectory."  Next  it  stores  the  current  space- 
craft heliocentric  ecliptic  state  and  the  VMP  trajectory  con- 
dition and  instrument  flags  so  that  they  can  be  returned  to  after 
the  event.  Then  the  VMP  flags  are  set  for  propagating  the  main 
probe.  Codes  are  used  to  stop  the  trajectory  after  90  days  of 
propagation  or  at  closest  approach  but  not  at  the  sphere  of 
influence.  The  VMP  stopping  condition  of  impacting  the  planet 
is  slightly  modified.  Rather  than  using  N0MNAL's  own  value  of 
target-planet  radius,  MPPR0P  transmits  to  VMP  the  radius  of  the 
probe  sphere  input  by  the  user  and  applied  throughout  probe 
targeting.  The  print  routine  is  activated  and  the  print  incre- 
ments are  set  at  5-day  and  100- integration  steps.  Next  VMP  is 
called  to  propagate  and  print  the  trajectory  until  a stopping 
condition  is  reached.  Finally,  the  original  spacecraft  state 
and  the  VMP  flags  are  restored  before  returning  to  GIDANS. 


270-5 


MULCON- 1 


MULC0N  Analysis 


The  equations  of  motion  of  a spacecraft  traveling  under  the  influence 
of  the  earth  and  moon  may  be  written 


r 


E 


^ErE  _ ^MrM  _ ^M^EM 
r 3 ’ r 3 " r 3 

E rM  rEM 


(1) 


where  "r^,  "rj.,  are  the  position  vectors  of  the  spacecraft- to-earth, 

the  spacecraft- to-moon,  and  the  moon- to-earth  respectively  and  fi 

are  the  gravitational  constants  of  the  earth  and  moon  respectively. 


The  multi-conic  approximation  of  the  solution  to  (1)  proceeds  as  follows. 
Let  "rL  , •vL  be  the  geocentric  state  at  some  time  t . This  state 

is  propagated  by  conic  formulae  to  obtain  an  estimat^  of  the  geocentric 
state  at  time  t^  - ^ + At  given  by  *^k+1,  \k+1  • 


To  account  for  the  third  term  perturbations,  the  state  of  the_moon  lelative 
to  the  earth  at  the  two  timepoints  is  computed,  denoted  by  (R^  k»  k) 

and  (R^  k+1)-  The  average  value  of  this  acceleration  is  then 

determined  from 


*Wk 

,k 


+ 


*Wk+l 

^EM.k+l 


(2) 


The  corrected  geocentric  state  is  then  given  by 


+ iA  (4  t)2 


E jk+1  E,k+1  2 

j.  ii  . t — * . 

/ “ v + A d t 

E,k+1  E,k+1 


(3) 


The  effect  of  the  direct  lunar  perturbations  is  then  added.  The  state 
of  the  spacecraft  relative  to  the  moon  is  first  computed 


CM,k+l  = rE,k-KL  ~ REM,k+l 


M,k+1 


k.  ti 

v 


E,k+1 


- V 

EM,k+l 


(4) 
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This  state  is  then  propagated  linearly  backwards  in  time  over  the  time 
interval  At  to  obtain 


^ f 

-A  1 

rM,k 

xa  y 

M,k-H 

fc 

a,  , 

vM,k 

VM,k+l 

VM,k+l 


At 


(5) 


This  state  is  now  propagated  forward  in  a selenocentric  conic  to  obtain 
a final  state  relative  to  the  moon  ( r^  vm  k+1  ^ Seocentric 

state  of  the  spacecraft  at  time  after  considering  all  terms  of  (1) 

is  then  given  by 


r 

*»  r 

+ R 

E,k+1 

M,k+1 

EM, k+1 

VE,k+l 

VM,k+l 

+ V 

EM, k+1 

(6) 


This  completes  one  cycle  of  the  multi-conic  propagation. 

The  multi-conic  propagation  proceeds  until  an  input  final  time  is  reached 
or  until  the  selenocentric  conic  passes  through  pericynthion. 


Reference:  Byrnes,  D.  V.  and  Hooper,  H.  L. , Multi-Conic:  A Fast  and 

Accurate  Method  of  Computing  Space  Flight  Trajectories, 
AAS/AIAA  Astro4ynamics  Conference,  Santa  Barbara,  Cal.,  1970, 
AIAA  Paper  70-1062. 
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MULTAR  Analysis 


Let  the  earth  equatorial  state  of  the  probe  at  the  LSI  as  computed  from 
the  patched  conic  targeting  be  denoted  r^g , v^g.  Subroutine  CAREL  is 

called  to  compute  the  conic  elements  and  conic  time  from  perigee  At 
based  on  the  geocentric  conic.  The  time  of  injection  is  then  computed 
as 


t t 

TLI  SI 


At 


(l) 


The  position  and  velocity  of  the  probe  at 


fcTLI 


is  given  by  the  state 


along  the  conic  at  perigee  (true  anomaly  of  zero)  and  determined  by 


ELCAR  to  be  r 


TLI’  TLI* 


If  0 


ECEQ 


is  the  transformation  matrix  from 


the  EC  (earth  ecliptic)  to  the  EQ  (earth  equatorial)  system,  then  the 
patched  conic  injection  state  in  EC  coordinates  is 


r 

I 


E5 


I 


SS 


T 

0 r 

ECEq  TLI 


v 

TLI 


(2) 


Since  the  earth  is  revolving  about  the  E-M  barycenter  in  time,  the  EC 
injection  state  must  be  rotated  if  an  earlier  or  later  injection  time  is 
to  be  used.  The  necessary  rotation  matrix  may  be  easily  computed  through 
the  introduction  of  the  R-T-W  coordinate  system.  Let  the  state  of  the 
earth  at  some  time  t.  in  BC  (barycentric  ecliptic)  coordinates  be 

K AAA 

denoted  R^,  V . Construct  the  R-T-W  system  at  that  point  as 


A 

R 


\ 


A 


-A 

\ * Vk 


A A A 
Tk  " \ * \ 


(3) 


AAA 

The  transformation  matrix  from  the  R^-T^-W^  system  to  the  ecliptic  system 
to  the  ecliptic  system  is  then  given  by 


\ 


I T, 


I 

l 


(4) 


At  a time  t the  state  of  the  earth  in  BC  coordinates  is  given'  by 

k+1  A A A 

R , V and  the  transformation  from  the  R - T - W system  to 
k+1  k+1  k+1  k+1  k+1 

ecliptic  coordinates  is  given  by  in  accordance  with  (4) . Injection 
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states  at  times  t^  and  t^+1  will  be  called  "equivalent"  if  they  are 

AAA 

identical  when  expressed  in  the  pertinent  R-T-W  system.  Therefore  if 

( } 'v  ) is  the  injection  state  in  EC  coordinates  at  time  t , the 

k k k 

equivalent  state  in  EC  coordinates  at  tk+1  is  given  by 


“ - 

it- 

— 

r—  — 

r 

^k+l  ,k 

0 

r 

k+1 

k 

Vk+1 

0 

U/ 

*Vf-l,k 

V 

k 

- 

— 

— 

— - 

where  the  rotation  matrix  xU  is  defined  by 


(5) 


xjf 

k+1  ,k 


(6) 


The  targeting  algorithm  used  by  MULTAR  may  now  be  described.  Let  the 
injection  state  in  EC  coordinates  on  the  k=th  iteration  be  denoted 
(tk,  "r^,  vk  ).  This  state  is  propagated  forward  using  the  multi-conic 

propagator  MULC0N  to  determine  a final  state  rM,  vM  to  the  moon  in  ecliptic 

coordinates.  IMPACT  is  then  called  to  compute  the  B'T^,  B-R^  anc*  tCA  k 

actually  achieved  on  the  trajectory  and  the  target  values  of  B**  T . B** R 

k k 

required  to  satisfy  the  i and  r_  constraints.  The  semi-major  axis 

LiA  uA 

a^  of  the  k-th  iterate  is  computed  from  the  conic  formula 


Errors  in  the  four  target  conditions 


At 


r 

cO 

i 

= 

* 

a - a 

Ab*t 

B-T.  - B*-T 
k k 

Ab«r 

B-Rk  B*^ 

Atr. 

* 

t - t 

CA 

CA  ,k  CA 

(7) 


(8) 


if  the  error  in  each  parameter  is  less  than  the  allowable  tolerance,  the 
process  stops. 
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If  convergence  has  not  been  achieved  a Newton- Raphs on  iteration  is  entered. 
The  four  controls  are  vk  > vk  > vk  * aru*  \ * ^or  t*le  velocity  components 

x y z k 

a perturbation  4v  is  added  to  the  pertinent  component  while  the  rest  of 
the  injection  state  is  held  constant  before  propagating  with  the  multi-conic. 
For  the  time  perturbation,  the  rotation  matrix  corresponding  to  the 

perturbed  time  t + At  (6)  is  first  computed.  The  injection  state  used 

K 


in  the  perturbed  propagation  for  time  is  then 


+ At,  r,  , i JfA 


-k  ■ ‘k’  '•'d  *k 

A sensitivity  matrix  is  computed  using  the  results  of  the  numerical 
differencing : 


X 


Av 


4b  t 

_ x 

4v 

X 

4b  r 

X 

4v 

X 

^CAx 

4v 


(9) 


^tCAt 

4t 


where  in  the  term 


is  the  change  in  the 


a 


target  parameter 


produced  by  the  variation  of  the  (3  control  component  and  4/?  is  the 
change  in  the  control  component.  The  k+1  iterate  controls  are  then 
given  by 


4c 


6 v 

X 

5v 

y 

6vz 

6 1 


X"1  4r 


(10) 


The  k+1  injection  state  is  then  computed  by  first  determining  the  injection 
state  after  rotation  due  to  the  change  in  injection  time  and  then  adding 
the  injection  velocity  corrections 


"k+1  " 

"k+1  = % "k  + 


(ID 


The  iteration  process  is  repeated  until  tolerable  errors  are  met.  The  con- 
verged injection  state  is  then  integrated  in  the  virtual  mass  trajectory. 
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MUND  Analysis 

The  nonlinear  equations  of  motion  of  the  spacecraft  can  be  written 
symbolically  as 


->  -»>  -»•  -> 

X = f(x,  y , t) 


Cl) 


where  x is  the  spacecraft  position/velocity  state  and  y is  a vec- 
tor composed  of  the  gravitational  constants  of  the  sun  and  the 
target  planet. 

Suppose  we  wish  to  use  numerical  differencing  to  compute  those 

columns  of  0 ,0  , and  0 associated  with  gravitational  con- 

xx  xu  xw 

s 

stant  biases  included  in  the  augmented  state  vector  over  the  time 
interval  [t^_^,  t^] . Let  Q.  (t^,  t^_^)  represent  the  column  as- 
asociated  with  the  j-th  gravitational  constant  bias.  We  assume 
we  have  available  the  nominal  states  x*(t,  ) and  x*(t,),  which,  of 

course,  were  obtained  by  numerically  solving  equation  (1)  using 

“)■  ->•  . 

nominal  y.  To  obtain  0.(t  , t ) we  increment  the  j-th  gravita- 

j k k— 1 

tional  constant  bias  by  the  pertinent  numerical  differencing  factor 
Ay.  and  numerically  integrated  equation  (1)  over  the  interval 

[t^_^,  t^]  to  obtain  the  new  spacecraft  state  x_.(t^),  where  the 

j-subscript  on  the  spacecraft  state  indicates  that  it  was  obtained 
by  incrementing  the  j-th  gravitational  constant  bias.  Then 


0 . ( t.  , t.  ) - — ^ 
i k k-1 


x,(tk)  - x*(tk) 


Ay . 
J 


(2) 
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MAVM  Analysis 

The  augmented  deviation  state  vector  is  defined  as 

>a  - . .it 


x’g,  Tf,  *v  J 


where 


it  m position  and  velocity  state  (dimension  6) 

It  = solve-for  parameter  state  (dimension  n ) 
s i 

if  «=  dynamic  consider  parameter  state  (dimension  n^) 

■v  = measurement  consider  parameter  state  (dimension  n^) 

The  linearized  equations  of  motion  have  form 

>f  “ F jT  + F it  + Fn 
1 2 s 3 

"x  “ 0 

s 

u = 0 

-v  - 0 

and  solution 

\+l  m 0(k+1’k)\  + 9XX  (k+1’k)irsk+  9XU  (k+1  ,k)\  + \ 


k+1 


^k+1 


k+1 


= v. 


where  dynamic  noise  has  been  added  to  the  solution  of  xk+^‘>  This 

solution  can  be  written  in  augmented  form 


— _ j.  A . v _ fc  A , A 

Vi  0 <k+l>k)  \ + \ 


where  the  augmented  state  transition  matrix  <%>  (k+l,k)  is  defined  as 
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Henceforth  state  transition  matrix  partitions  will  be  written  without 
stating  the  associated  interval  of  time,  which  will  always  be  assumed  to 
be  [k, k+l]  . 

The  measurement  deviation  vector  y (dimension  m)  is  related  to  the 
augmented  deviation  state  vector  through  the  equation 


where  the  augmented  observation  matrix  is  defined  as 

\A  - [\  \ \ \] 

and  T)  is  measurement  noise, 
k 

The  augmented  state  covariance  matrix  P,  can  be  written  in  terms  of 

k 

its  partitions  as 
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Propagation  and  update  aquations  for  the  partitions  appearing 
in  the  previous  equation  will  be  written  below.  Equations  need 
not  be  written  for  the  consider  parameter  covariances  and 

since  these  do  not  change  with  time.  Also,  C will  be  set  to 

uv 

zero  because  of  the  assumption  that  no  cross-correlation  exists 
between  dynamic-  and  measurement- consider  parameters.  In  the 
equations  below,  Q and  R represent  the  covariances  of  the  dynamic 
and  measurement  noises,  respectively,  defined  previously.  A minus 
superscript  on  covariance  partitions  indicates  the  covariance 
partition  immediately  prior  to  processing  a measurement;  a plus 
superscript,  immediately  after  processing  a measurement.  If  IC0DE 
indicates  that  a measurement  Is  not  to  be  processed,  the  update 
equations  are  bypassed.  To  improve  numerical  accuracy  and  avoid 
nonpositive  definite  covariance  matrices,  P , Pg,  P+,  and  P^,  are 
always  symmetrized  after  their  computation. 


The  propagation  equation  are  given  by 

- / + +T  +T  \ T 

p,  , « , Up,  + e c + e c | <j>  + 
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xx  xx  xu,  ,,  xu  k 

Sk+1  S ^+1 


xx 


+ + 

= 6 C +6  P+0C 

r XX  XX  S,  XU  X u, 

1 , , s,  s k s k 

k+1  k 

+ 


P = P 
Sk+1  Sk 


: = bc+  +e  c+  + e u 

xVi  xuk  xxs  xs\  xu  ° 


CxaVi 


XV, 


= 4>c 


k+1 


XV, 


+ 0 


XX 


X V, 

s k 


s k+1 


X V. 
s k 
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The  measurement  residual  covariance  matrix  is  given  by 


Jk+1  \+l  \+l  + “k+l  Bk+1  + Gkf  1 °k+l  + Lk+1  E'  • * + 


k+1 


\+l 


where 


\+l  Pk+1  \+l  + Cxx  \fl  + Cxu,  Gk+1  + Cxv  L 

sk+i  Vtl  k+1 


T 

k+1 


Bk+1  Ps  \+l 
k+1 


+ C 


xx  ^Sc+l  x u.  , . k+1 

S,  ,.  s K+1 

k+1 


ah + c;  v„+1 

s k+1  s k+1 


Vi  ■ ^ + c'4+1  ^ + u°  gI 


s 

T 


k+1 


E.  . . - C 


“k+1  “xv,  ^+1  + Cx  v,  . , \+l  + Vo  'Sc+l' 


k+1 


sk+1 


The  covariance  matrix  partitions  immediately  after  processing  a 
measurement  are  given  by  the  following  update  equations: 

Pk+1  = Pk+1  “ Kfc+-1  Vl  " \+l  \+l  + ^+1  Jk+1  \+l 


C+  = C 

XX  XX 

Sk+1  Sk+1 


\+l  Bk+1  ” \+l  Sk+1  + \+l  Jk+1  Sk+1 


+ T T T 

p = p - s, . . b,  - b.  ,,  s.V,  + s,  j.  ..  sr,. 

s,  . . s.  . , k+1  k+1  k+1  k+1  k+1  k+1  k+1 

k+1  k+1 


+ T 

C = C.  - K.  . D,  , . 

xuk+i  lVi  ^+1  k+1 


+ T 

C = C - S.  ..  D,  ,, 

x Vi  xsVi  k+1  fc±1 


s 


C+ 

XV 


= C 


k+1 


*Vi  ’ Kk+1  E 


T 

'k+1 


+ - T 

C - C - S.  ..  ET.1 

xv...  xv...  k+1  k+1 

8 k+1  s k+1 
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where  gain  matrices 


gain  subroutine — GAIN1, 


and  are  computed  in 

if  Kalman-Schmidt,  GAIN2, 


the  appropriate 
if  WLS . 
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NDTM  Analysis 


The  nonlinear  equations  of  motion  of  the  spacecraft  can  be  written  symbol- 
ically as 


f ( "x , t ) 


(1) 


where  x is  the  spacecraft  position/velocity  state. 


Suppose  we  wish  to  use  numerical  differencing  to  compute  the  state  tran- 
sition matrix  0(t^,  t^  ^)  . Let  (^(t^,  t^  represent  the  j-th  column 


tk-i)- 


We  assume  we  have  available  the  nominal  states 
To  obtain  ^*  (t^, 


x *(t 


k-1 


) 


t,  i ) we  increment  the  i-th  element  of 
k-  1 


of  0j(tk  = 
and  ■£**(&) . 

, * ^ j - . 

x (t^  by  the  numerical  differencing  factor  Ax.  and  numerically  integrate 
equation  (1)  over  the  time  interval  J^t^  ^ , t^  J to  obtain  the  new  space- 


craft state 


W 


The  j- subscript  indicates  x (t  ) was  obtained  by 


incrementing  the  j-th  element  of  x (t^ 


Then 


r,<tk)  --4*(tfc) 


ar(t  , t > 

'j  k’  k-1 


AV 


(2) 


j 1,2,...,  6 
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NOMNAL  Analysis 

NOMNAL  is  the  executive  program  controlling  the  entire  generation  of  a 
nominal  trajectory  from  injection  targeting  through  midcourse  corrections 
and  orbit  insertion. 

NOMNAL  begins  by  calling  PRELIM  for  the  preliminary  work  including 
initialization  of  variables,  reading  of  the  input  data,  and  computation 
of  zero  iterate  values  of  initial  time,  position,  and  velocity  if  required. 

NOMNAL  then  calls  TRJTRY.  TRJTRY  first  determines  the  time  of  the  next 
guidance  event.  It  then  integrates  and  records  the  nominal  trajectory  to 
that  time.  TRJTRY  then  returns  control  to  NOMNAL. 

NOMNAL  next  calls  GIDANS.  GIDANS  processes  the  computation  and  execution 
of  the  current  guidance  event.  NOMNAL  then  reenters  its  basic  cycle  by 
calling  TRJTRY  to  propagate  the  corrected  trajectory  to  its  next  guidance 
event . 

Two  flags  are  used  by  NOMNAL.  The  flag  IPRE  is  initialized  at  zero  in 
NOMNAL.  During  the  processing  of  the  first  data  case  PRELIM  sets  it  to 
unity.  PRELIM  uses  IPRE  to  determine  whether  to  preset  constants  to 
internally  stored  values  or  leave  them  at  their  previous  values  before 
reading  the  next  data  case. 

The  second  flag  KWIT  determines  whether  the  current  case  should  be  continued 
or  terminated  according  to  the  flag  value  zero  or  unity  respectively.  Ter- 
mination is  indicated  when  a fatal  error  occurs  during  trajectory  propagation 
or  guidance  event  computation  or  when  the  desired  end  time  is  reached. 
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NOMNAL  Flow  Chart 


NONINS- 1 


NONINS  Analysis 


NONINS  determines  the  time  and  correction  vector  for  an  impulsive  insertion 

from  an  approach  hyperbola  into  a specified  plane  and  as  near  as  possible 

to  a prescribed  closed  orbit.  The  approach  hyperbola  is  specified  by 

giving  the  planetocentric  equatorial  state  r,  "v  at  the  time  of  decision 

t,.  The  final  orbit  is  defined  by  giving  its  desired  orbital  elements 
d 

(a_,  e_ , again  in  planetocentric  equatorial  coordinates. 

E E E E E 


Subroutine  CAREL  is  first  called  to  convert  the  hyperbolic  state  at  decision 
r\  aT  into  Keplerian  conic  elements  (a„ , e. 


into  Keplerian  conic  elements  (a  , , 

rl  n 

is  the  time  from  periapsis  at  decision  (negative  on  the  approach  ray). 


hr  Hr  ^H’ 


tHd)  where  tR(J 


The  points  of  intersection  of  the  approach  orbital  plane  and  the  desired 
orbital  plane  are  then  determined.  The  elements  defining  the  two  planes 
are  therefore  given  by  iR,  .PR  and  iR,42R  . Let  A denote  the  unit 

vector  toward  the  ascending  node  of  an  orbit  and  B denote  the  in-plane 
normal  to  A in  the  direction  of  motion.  Then 

(cos  Q , sin  L , 0) 


A 

A 


A 

B *=  (-sin  12  cos  i,  cos  Q cos  i,  sin  i) 

A A A A 

Hence  the  normal  to  the  orbital  plane  G is  given  by  C = A x B or 
A 

C = (sin  Q sin  i,  -cos£?  sin  i,  cos  i) 


(1) 

(2) 

(3) 


The  direction  of^ the  line  of  intersection  of  the  two  planes  is  therefore 

determined  by  X = U x u or 

H E 


(cos  iR  sin  iF  cos  ^ - sin  iu  cos  iF  cosi2u, 


H 


'H* 


cos  i sin  i sin  Q - sin  i cos  i„  sini2„, 
n E E rl  E rl 

sin  ijj  sin  i^  (cos  £2R  sini2£  - sini2R  cosJ^))  (4) 

Then  the  unit  vector  along  the  line  of  intersection  toward  the  northern 
hemisphere  iB  given  by 

A t 

X = sgn  X,  — - - (5) 

J X 

Therefore  the  true  anomaly  fRX  along  the  hyperbola  at  the  northern  inter- 
section point  is  given  by 

cos  (0>H  + f^)  = X • AR  (6) 


290 


NONINS- 2 


The  true  anomaly  on  the  hyperbola  at  the  southern  point  is  therefore 
f + 180°.  Note  that  there  exists  a region  of  true  anomalies  lying  be- 
t$$en  the  incoming  and  outgoing  asymptotes  for  which  the  hyperbola  is  not 
defined.  Similar  equations  define  the  true  anomaly  on  the  ellipse  at  the 
two  points  of  intersection.  Note  that  this  implies  that  the  modified 
ellipse  will  have  the  same  0)  as  the  desired  ellipse. 

For  the  intersection  true  anomaly  fHY  the  radius  magnitude  on  the  hyper- 
bola may  be  determined 


1LA 


aH^  " CH‘> 

1 + e„  cos  f„ 


(7) 


To  permit  an  impulsive  insertion,  a^  and 

aE^  " eE^ 

•£  * = 

T 1 + e cos  f 

EE 

There  are  three  candidate  modifications  examined  to  determine  a "best" 
one:  (1)  Vary  r&  while  holding  r^  constant 

(2)  Vary  r while  holding  r constant 

P & 

(3)  Vary  a while  holding  e constant 


eg  must  be  modified  to  satisfy 


(8) 


"Best"  is  defined  below  in  terns  of  a weighted  scalar  function  of  the 

changes  in  r and  r 
a p 


Rewriting  (8)  in  terms  of  ra  and  r^  (using  a = , e = — — yields 


r +r  r -r 

e = 


the  useful  relation 


r r 
a p 


2r  r 
a_£ 


r (1  + cos  f ) + r (1  - cos  f ) = 
a E P E r 


(9) 


Equation  (9)  may  be  solved  for  r as 

a 


rIrp(l  - fE) 

2 r - r (1  + cos  f ) 


(10) 


This  yields  the  r which  defines  the  modified  orbit  holding 
desired  value.  The  semi-major  axis  and  eccentricity  are  then 


r - r 

_§ E 

ra+rp 


r at  its 
P 

computed  from 
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Similarly  (9)  may  be  solved  for  r^  as 

rTr  (1  + cos  f) 

la  ( 

x « . . — ■ ^ 

p 2 r - r (1  - cos  f) 

3 J. 

This  determines  the  modification  is  r required  to  achieve  an  inter- 

P 

secting  ellipse  having  the  desired  r&  . 

Finally  (8)  may  be  solved  trivially  for  the  a required  to  produce 

i-i 

intersection  for  the  desired  eccentricity. 


aE  “ 


r^l  + e£  cos  f£) 

(i  - 4) 


(12) 


An  error  is  assigned  to  each  of  the  candidate  solutions  as 


E.  = W. 

l l 


lAra  + 


Ar 


where  Ar  , A r are  the  errors  between  the  desired  and  modified  values 
a p 

of  r and  r . The  weighting  factor  W.  is  assigned  rather  arbitrarily, 
a p 1 

Currently  the  weighting  factor  is  = w^  w^^  where 


w 


li 


w 


2i 


1 if  the  true  anomaly 

2 if  the  true  anomaly 

1 if  option  1 

2 if  option  2 

3 if  option  3 


is  on  the  incoming  ray 
is  on  the  outgoing  ray 


Thus  a solution  on  the  incoming  asymptote  is  preferred  over  one  on  the 
outgoing  asymptote  and  one  subsequent  trim  is  preferred  over  two  subsequent 
trims . 


Having  determined  the  elements  of  an  intersecting  orbit  the  insertion  para- 
meters are  easily  computed.  The  velocity  on  the  hyperbola  at  the  intersection 

point  may  be  computed  from  ELGAR  as  "v  . The  velocity  on  the  ellipse  following 

H 

the  insertion  is  computed  by  calling  ELGAR  with  the  modified  elliptical  ele- 
ment to  get  "v  . The  impulsive  Sv  is  then  given  by 
E 


A v 


The  time  interval  from  the  decision  to  the  execution  is  given  by  the  hyper- 
bolic time  from  the  initial  point  to  the  relevant  intersection  point. 


NONINS- 4 
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N0NLIN  Analysis 


N0NLIN  is  the  interface  subroutine  between  the  non-linear  guidance  sub- 
routines of  N0MNAL  and  subroutine  GU1DM  of  ERRAN  and  subroutine  GUISIM 
of  SIMUL.  N0NLIN  selects  the  necessary  data  from  the  ERRAN  and  SIMUL 
common  blocks  and  stores  into  the  common  blocks  of  N0MNAL  the  information 
needed  to  compute  and/or  execute  the  AV  required  in  order  to  meet 
specified  target  conditions. 

The  most  important  task  performed  by  N0NLIN  is  the  selection  of  the  desired 
guidance  scheme.  The  variable  IX  is  tested  and  control  is  transformed 
according  to  the  following: 

IX  = 1 , retargeting  to  specified  target  parameters 
= 2,  orbit  insertion  to  specified  orbit 
= 3,  AV  execution  by  a series  of  specified  pulses 

For  each  type  of  event,  N0NLIN  then  sets  up  values  controlling  the  type  of 
guidance  event  (KTYP) , implementation  code  (KMXQ),  and  execution  model 
code  (MDL) . For  retargeting  only,  N0NLIN  stores  the  remaining  values 
needed  for  AV  calculation  and  prints  the  zero  iterate  conditions. 

N0MNAL  calls  GIDANS  to  perform  the  guidance  event  and  restores  parameters 
necessary  for  the  basic  cycles  of  ERRAN  and  SIMUL.  For  retargeting  only, 
N0MNAL  then  stores  the  conditions  at  sphere  of  influence  and  closest 
approach  of  the  target  planet  which  were  calculated  by  subroutine  TARGET. 
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NTM  Analysis 


Subroutine  NTM  is  used  to  generate  the  (most  recent)  targeted  nominal 
trajectory  in  the  error  analysis  mode.  Subroutine  NTM  is  equivalent  to 
a subroutine  NTMS  from  which  all  loops  associated  with  1C0DE  = -3,  -2,  2,  3 
have  been  removed.  For  this  reason  no  further  analysis  and  no  flow  chart 
will  be  presented  for  subroutine  NTM.  Refer  to  subroutine  NTMS. 
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NTMS  Analysis 


Subroutine  NTHS  is  used  to  generate  any  of  the  three  trajectories  required 
in  the  simulation  mode  --  the  (most  recent)  targeted  nominal  trajectory, 
the  most  recent  nominal  trajectory,  and  the  actual  trajectory. 

The  input  variable  ICODE  is  used  to  distinguish  between  these  trajectories. 

It  is  unimportant  to  the  virtual  mass  technique  which  trajectory  is  being 
computed.  However,  it  is  important  to  keep  them  separated  so  that  the 
proper  codes  are  set  that  check  for  approaching  the  sphere  of  influence  of 
the  target  planet  and  reaching  closest  approach.  It  is  also  important  to 
keep  separate  the  conditions  at  which  these  occur  for  each  trajectory.  The 
following  list  describes  ICODE  completely. 

ICODE  = 3,  NTMS  will  check  to  see  if  the  sphere  of  influence  and/or 
closest  approach  has  been  reached  on  the  actual  trajectory. 

If  net,  VMP  will  check  for  these  conditions  and  on  encountering 
either,  NTMS  places  the  conditions  in  special  storage  locations 
so  they  will  be  saved  for  future  reference. 

ICODE  «=  2,  NTMS  performs  the  same  operations  as  described  above  for  the 
most  recent  nominal  trajectory. 

ICODE  = 1,  NTMS  again  checks  for  sphere  of  influence  and  closest  approach 
as  above  for  the  targeted  nominal  trajectory. 

ICODE  = 0,  the  only  important  information  in  this  situation  is  the  state 
vector  at  the  end  of  the  time  interval.  Therefore,  NTMS  does 
not  check  to  see  if  closest  approach  or  sphere  of  influence  is 
encountered.  This  might  occur  in  numerical  differencing,  for 
example . 

ICODE  = -1,  it  is  important  to  know  if  sphere  of  influence  or  closest 

approach  is  reached  on  the  targeted  nominal  trajectory.  However, 
it  i6  not  desired  that  the  information  be  stored  for  future  use. 
This  situation  occurs  in  the  guidance  event. 

ICODE  = -2,  the  same  comments  may  be  made  as  if  ICODE  = -1,  except  this 
is  on  the  mo6t  recent  nominal  trajectory. 

ICODE  >=  -3,  again,  this  value  of  ICODE  is  treated  the  same  as  is  ICODE  = 
-1,  for  the  actual  trajectory. 

Physical  constants,  planetary  ephemerides , and  other  information  relating 
to  the  dynamic  model  are  the  same  for  the  targeted  and  most  recent  nominal 
trajectories.  This  is  not  true  for  the  actual  trajectory.  There  may  be 
biases  in  the  target  planet  ephemerides  and  the  gravitational  constants  of 
the  Sun  and  target  planet.  The  numerical  accuracy  and  the  number  of  celes- 
tial bodies  employed  in  the  generation  of  the  actual  trajectory  may  also 
differ . 


NTMS-2 


Ephemeris  biases  are  specified  as  biases  in  orbital  elements  a,  e,  i,  ft, 

CO,  and  M . However,  within  the  program  are  stored  the  ephemeris  constants 
of  a,  e,  i,  ft,  co,  and  M for  the  planets  and  a,  e,  i,  ft,  Co,  and  L for 
the  moon,  where 

/\J  0 

w .=  w + Q 

and 

L = M + co  + ft  . 

Incrementation  of  co  and  L requires  addition  of  biases  in  ft  , co,  and 
M as  indicated  by  the  above  equations. 


299 


NTMS-3 


NTMS  Flow  Chart 


Ar\rv 

JUU 


NTMS-4 
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Did  targeted  nominal  pierce 
sphere  of  influence? 


Did  most  recent  nominal 
pierce  sphere  of  influence? 


Was  sphere  of  influence 
previously  pierced? 


Was  sphere  of  influence 
previously  pierced? 


IS0I1 


IS0I2 


Store  sphere  of  influence 
conditions  for  the  targeted 
nominal  trajectory.  Write 
out  sphere  of  influence 
conditions 


Store  sphere  of  influence 
conditions  for  the  most  recent 
nominal  trajectory.  Write 
out  sphere  of  influence 
conditions . 


Was  closest  approach 
previously  encountered? 


Was  closest  approach 
previously  encountered? 


Store  closest  approach  con- 
ditions for  the  targeted 
nominal  trajectory 


Store  closest  approach  con- 
ditions for  the  most  recent 
nominal  trajectory. 


Did  targeted  nominal  en- 
counter closest  approach? 


Did  targeted  nominal  en- 
counter closest  approach? 


ICA1  = 1 


ICA2  = 1 


Write  out  closest  approach 
conditions . 


Is  most  recent  nominal 
identical  to  target  nominal? 


Write  out  closest  approach 
conditions . 

NO 

** 

% 

/ 
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Did  actual  trajectory 
pierce  sphere  of  influence? 


Was  actual  trajectory 
computed? 


Was  sphere  of  influence 
previously  pierced? 


Reset  dynamic  parameters 
and  trajectory  numerical 
accuracy  to  their  nominal 
values . 


RETURN 


Store  sphere  of  influence 
conditions  for  the  actual 
trajectory.  Write  out 
sphere  of  influence  con- 
ditions . 


f Was  closest  approach 

previously  encountered? 


Store  closest  approach  don- 
ditions  for  the  actual 
trajectory. 


Did  actual  trajectory 
encounter  closest  approach 


Write  out  closest  approach 
conditions . 


r a 
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ORB  Analysis 


ORB  determines  the  mean  orbital  elements  for  any  gravitational  body  at 
a specified  time. 

The  elements  used  are  semi-major  axis  a , eccentricity  e , inclination  i , 
longitude  of  the  ascending  node  & , and  longitude  of  periapsis  co.  These 
elements  are  referenced  to  heliocentric  ecliptic  for  the  planets  or  geo- 
centric ecliptic  for  the  moon. 

The  mean  elements  are  computed  from  time  expansions  as  follows.  Let  a be 
any  of  the  elements.  Then  the  value  of  a at  any  time  t is  given  by 

2 3 

a(t)  = a + a,t  + o _t  + at 
o 1 2 3 

Where  the  constants  a are  stored  by  BLOAT.  These  constants  are  stored 

k 

into  the  arrays  CN,  ST,  and  EMN  for  inner  planets,  outer  planets,  and 
the  moon  respectively.  The  definitions  of  these  arrays  and  the  values 
stored  are  provided  in  the  analysis  of  the  previous  subroutine  BLOAT.  The 
element  value  as  computed  from  the  above  equation  is  then  returned  in  the 
EIMNT  array  according  to  the  gravitational  body  code  k as 


ELMNT (8k- 15)  = i 

k = 1 

Sun 

= 1 

Saturn 

EIMNT (8k- 14)  = fi 

2 

Mercury 

8 

Uranus 

EIMNT  (8k- 13)  = Co 

3 

Venus 

9 

Neptune 

EIMNT (8k- 12)  = e 

4 

Earth 

10 

Pluto 

EIMNT (8k- 10)  « a 

5 

Mars 

11 

Moon 

EIMNT  (8k- 9)  = co 

6 

Jupiter 
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NTRY  Analysis 

Subroutine  NTRY  transforms  the  heliocentric  ecliptic  spacecraft 
state  and  covariance  matrix  to  entry  parameter  coordinates . This 
information  is  useful  in  defining  initial  data  for  the  Lander 
Trajectory  Reconstruction  (LTR)  program.  Subroutine  NTRY  also 
computes  the  communication  angle  at  entry. 

The  entry  parameter  state  is  defined  by  altitude  h,  velocity  v 
relative  to  the  planet,  flightpath  angle  y,  longitude  of  the 
ascending  node  , inclination  i of  the  entry  plane,  and  the 

angle  <j>  between  the  ascending  node  and  the  <j>  reference  line. 

These  latter  angles  are  all  defined  relative  to  the  subsolar 
orbital-plane  coordinate  system  xg  yg  zg,  which  is  defined  in 

subroutine  SUBS0L.  All  entry  parameters  are  shown  in  the  follow- 
ing figure,  as  is  the  communication  angle  ip. 


NTRY-2 


The  transformation  of  the  heliocentric  ecliptic  spacecraft  state 
to  the  entry  parameter  state  requires  first  that  the  target  planet 
heliocentric  ecliptic  state  be  subtracted  to  obtain  the  relative 
spacecraft  position  r and  velocity  v.  The  equations  for  trans- 
forming r = (rx,  ryf  rj  and  v = vyf  v ^ to  (h,  v,  Y,  <J»g , 

i , Q ) are  summarized  below, 
s si 


X “*■  V x v -v 

Define  e = — and  e = , where  e is  a unit  vector  aligned 

r r n i-*-  -vi  r 6 

r x v 


with  r and  e is  a unit  vector  normal  to  the  entry  plane.  Let 
n 

denote  a unit  vector  aligned  with  the  z^-axis.  The  Cartesian 


e 

z 


subsolar  orbital-plane  components  of  these  three  unit  vectors 
will  be  denoted  as  follows: 


e2  = (0,  0,  1) . 


Altitude  h and  velocity  v are  readily  obtained: 


h = | r I - R 

(1) 

P 

i t 

v = | v | 

(2) 

where  is  the  target  planet  radius.  Flightpath  angle  y is 
computed  from 


where 
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Longitude  of  the  ascending  node  ft  is  given  by 


ft  = tan“*  — — 
s -e 


y 


while  inclination  i is  obtained  from 

s 


i = cos'1 
s 


N) 


The  angle  <|)  is  given  by 


sin  d> 

-1  / 


, = tan  . 

s \ cos  4> 


where 


sin 


s sin  i 


s 


and 


cos 


e e + e e \ 
n r n r h 
\ y x x y • 


Ve  2 + e 2 
n n 

L y 


1L 

k • 


If  i = 0 or  180  degrees,  the  following  equation  for  <f>  is 
s s 

instead: 


<b  ~ tan 
s 


"I  —Z 


- ft  . 

s 


The  desired  entry  parameter  covariance  matrix  is  defined  b; 

P = E [x  xT] 


(4) 


(5) 


(6) 


used 


(7) 


(8) 
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where  x = |6h,  6v,  6y  6<f>s)  . Given  the  covariance  matrix 

P'  = E x-  x'T]  (9) 

where  x"  = (<$r  , 6r  , 6r  , 8v  , 6v  , 6v  ) , the  desired  covariance 
\ x y z x y z/ 

matrix  can  be  obtained  from 

P = A P"  AT  (10) 

where  transformation  matrix  A is  defined  by 

x = A x'.  (11) 

The  elements  a„  of  the  4x6  matrix  A are  found  by  computing  the 

differentials  of  equations  (1),  (2),  (3),  and  (6).  The  results 
of  this  process  are  summarized  as: 


a44  a45  a46  “ ° 

where  h"  = |r  x v|  and  is  the  orbit  angular  momentum/ unit  mass. 
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Communication  angle  ip  is  computed  from 


cos 


<J>  = 


(K  - K) 


- r 


(12) 


where 


r = spacecraft  position  relative  to  planet 

— V 

re  = Earth  position  relative  to  sun 
r = planet  position  relative  to  sun. 
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PARTL  Analysis 


PARTL  is  responsible  for  the  computation  of  the  partials  of  B*T  and 
B*R  with  respect  to  the  cartesian  components  of  position  and  velocity . 

Let  the  state  of  the  spacecraft  with  respect  to  the  target  body  at  inter- 
section with  its  sphere  of  influence  be  denoted 


X,  y,  z ] T 

r = V x2  + y2  + z2 

(1) 

[x,  y , z ] T 

v = V x2  + y2  + z2 

(2) 

/\ 

Introduce  the  approach  asymptote  S and  approximate  it  by  the  direction 
of  v 

^ = £ (3) 

v 

/s 

The  B-plane  is  the  plane  normal  to  X containing  the  center  of  the  target 
body.  Any  vector  ^ within  the  B-plane  must  satisfy  therefore 

'S  • f}  = 0 (4) 

The  impact  parameter  vector  B is  determined  by  the  Intersection  of  the 
B-plane  and  the  incoming  asymptote.  The  incoming  asymptote  is  given  par- 
ametrically by 

<7  = r*  + V t (5) 

The  time  at  which  the  asymptote  intersects  the  B-plane  may  be  determined 
by  applying  the  B-plane  condition  (4) 

A i A „ 

S • r + S • v t = 0 


t = 


r.  v 

2 


Therefore  the  B-vector  is  given  by 


r-I^  v 


x - ax,  y - ay,  z - a 


’z] 


where  a = LL1  = ™±.Xy.+  H 

2 .2  .2  , .2 

v x + y + z 


(6) 


(7) 
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Now  assuming  that  the  T axis  is  to  lie  in  the  x-y  reference  plane  and 
the  B-plane,  it  is  defined  as 


T 

S x K 

X 

| S x K | 

/\ 

T 

= 

« • 

* , - - , 
u u 

2 

where  u = 

X2  4 

- y2  . The 

R 

= 

S x T 

A 

R 

= 

i r-  • # • 

— xz , yz 
uv  L 

°J 

R axis  is  defined  by 


(8) 


(9) 


Now  combining  (7),  (8),  (9)  B-T  and  B*R  may  be  computed  in  terms  of 
the  state  components 


B-T  = — (xy  - xy) 

u 

(10) 

B*R  = — [ (xx  + yy)z  - u^  zl 

uv  L J 


where  u2  = x2  + y2  , v2  = u2  + z2. 


The  partials 

may  now  be  computed  from 

dB.T 

= i 

aB-R 

5x 

u 

ax 

5b*t 

_ _ X 

aB*R 

dy 

u 

dy 

5b-t 
d z 

= 0 

aB-R 

dz 

$B*T 
d x 

D 

II 

(xx  + yy) 

aB-R 

a* 

C?B  = T 

ay 

a 

m JL 
u3 

(xx  + yy) 

Ob-r 

ay 

aB.T 

a z 

= 0 

aB-R 

dz 

differentiation  of  the  above  equations. 


= xz 
uv 

= it 

uv 

_ _ u 
V 

z 

3 3 
u V 

\i~  (v^x  - xzz)-x(u^  + v2)  (xx  + yy) 

z 

3 3 

u2 (v  y - yzz)-y(u2  + v^) (xx  + yy) 

u v 


= ~ (xx  + yy  + zz) 

vJ 
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PCTM  Analysis 


Subroutine  PCTM  does  not  actually  compute  the  state  transition  matrix 
^(t^,  t^  itself;  this  is  accomplished  by  calling  C0NC2  from  within 

PCTM.  The  primary  function  of  PCTM  is  to  determine  the  dominant  body  at 
time  ^ to  be  used  in  the  computation  of  0(t^,  by  means  of  the 

analytical  patched  conic  technique. 


On  interplanetary  trajectories  we  compute  the  distance  separating  the 
spacecraft  from  each  of  the  celestial  bodies  included  in  the  analysis. 

If  the  distance  between  the  spacecraft  and  the  i- th  body  is  less  than  or 
equal  to  1.1  times  the  sphere  of  influence  of  the  i- th  body,  the  i-th 
body  is  selected  as  the  dominant  body.  Otherwise,  the  Sun  is  selected  as 
the  dominant  body. 


On  lunar  trajectories  we  compute 
from  the  Moon.  If  this  distance 
sphere  of  influence  of  the  Moon, 
If  not,  the  Earth  is  selected  as 


the  distance  separating  the  spacecraft 
is  less  than  or  equal  to  1.1  times  the 
the  moon  is  selected  as  the  dominant  body, 
the  dominant  body. 
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PCTM  Flow  Chart 


PCTM-2 


ENTER 


Compute  Julian  date  at  t^.  ^ . 


Is  reference  coordinate  system 
heliocentric  or  barycentric 
. ecliptic? , 

. , helio  - 


bary  - 


1 = 1 


= 1+1 


Compute  position  and  velocity  of  I- th 
body.  Compute  position,  velocity, 
and  position  magnitude  of  spacecraft 
relative  to  I-th  body. 


Is  spacecraft  within  1.1  times  the 
sphere  of  influence  of  the  I-th  body? 


Have  all  celestial  bodies 
been  treated? 


Select  I-th  body  as 
dominant  body. 


Select  Sun  as  dominant  body 


Compute  gravitational  constant  of 
dominant  body. 


Call  C0NC2  to  compute  $ 
analytically  over  the  time 
interval  [ t*.  j . tj. 


RETURN 


PCTM-3 
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PECEQ  Analysis 

Subroutine  PECEQ  computes  the  coordinate  transformation  maxtrix 
A from  planetocentric  ecliptic  to  planetocentric  equatorial  co- 
ordinates for  an  arbitrary  planet. 


The  derivation  of  A for  a planet  other  than  the  earth  or  moon 
will  be  summarized.  Matrix  A is  defined  by 


A = [x  ] Y | z]T  (1) 

where  X,  Y,  and  Z are  unit  vectors  aligned  with  the  planetocentric 
equatorial  coordinate  axes  and  ref erenced^ to  the  planetocentric 
ecliptic  coordinate  system.  Unit  vector  Z is  aligned  with  the 
planet  pole.  Unit  vector  X lies  along  the  intersection  of  the 
of  the  planet  equatorial  and  orbital^planes  and  points  at  the 
planet  vernal  equinox.  Unit  vector  Y completes  the  orthogonal 
triad  and  is  given  by 

Y = Z x x.  (2) 

A A /» 

It  remains  to  obtain  expressions  for  X and  Z.  Let  N denote  the 
unit  vector  normal  to  the  planet  orbital  plane,  and  let  P denote 
the  unit  vector  aligned  with  the  planet  pole.  Then 

Z = P (3) 


and 


P x n 
|P  x N 


(4) 


The  unit  vector  N,  referred  to  the  ecliptic  coordinate  system,  is 
given  by 


N = 


where  i and  fi  are  the  inclination  and  longitude  of  the  ascending 
node,  respectively,  of  the  planet  orbital  plane.  The  unit  vector 
P,  referred  to  the  ecliptic  system  is  given  by 


(5) 
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P 


cos  a cos  6 

cos  e sin  a cos  6 + sin  c sin  6 
- sin  c sin  a cos  6 + cos  c sin  6 


(b) 


where  a and  6 are  the  right  ascension  and  declination,  respec- 
tively, of  the  planet  pole  relative  to  the  geocentric  equatorial 
coordinate  system,  and  e is  the  obliquity  of  the  ecliptic.  Ex- 
pressions for  a and  <5  for  each  planet  were  obtained  from  JPL  TR 
32-1306,  Constants  and  Related  Information  for  Astrodynamic  Cal- 
culations, 1968,  by  Melbourne,  et  al. 


For  the  earth  and  the  moon,  the  transformation  matrix  A is  writ- 
ten as  the  produce  of  two  transformation  matrices 


A = A2  A . 


(7) 


For  the  earth  A 2 is  the  identity  matrix  and  A^  is  given  by 


Al  = 


0 

cos  c 
sin  c 


(B) 


The  following  figure  defines  the  transformations  A^  and  A 2> 
using  the  definitions  given. 


XYZ  Ecliptic  coordinate  axes 

X Y Z Orbital  plane  coordinate  axes 

o o o 


Wq 


n 

6 


e 


Moon's  equatorial  coordinate  axes 

Inclination  of  moon's  orbital  plane  to  ecliptic 
plane 

Right  ascension  of  moon's  orbital  plane  to 
ecliptic  plane 

Inclination  of  moon's  equatorial  to  orbital 
plane 

Right  ascension  of  moon's  equatorial  to  orbital 
plane 


311 


PECEQ-3 


Z 


The  transformation  from  ecliptic  to  orbital  plane  coordinates 

is  performed  by  rotating  about  the  z-axis  through  an  angle  ft  and 
then  about  the  resulting  x-axis  through  an  angle  i.  Symbolically, 

= (ft  about  3,  i about  1).  (9) 

The  transformation  A^  from  orbital  plane  to  equatorial  coordinates 
can  be  written  similarly  as 

A 2 = (0  about  -3,  6 about  -1).  (10) 
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PECEQ  Flow  Chart 
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PERHEL  Analysis 


PERHEL  is  responsible  for  propagating,  a heliocentric  trajectory  considering 
the  perturbations  produced  by  both  the  launch  and  target  bodies . The  equa- 
tions of  motion  of  a body  moving  under  the  influence  of  the  sun  while  per- 
turbed by  a smaller  mass  are 


r - r, 


m 


0) 


where  r is  the  vector  radius  from  the  sun  to  the  spacecraft 

~r  is  the  vector  radius  from  the  sun  to  the  perturbative  mass 

m 

, fu  are  the  gravitational  constants  of  the  sun  and  mass  respectively. 


Assuming  that  the  indirect  term  is  small,  attention  may  be  directed  to  the 
.first  two  terms  only.  Suppose  that  ( ~r“0 ( t ) , "v*  (t))  satisfy 


r 

o 


(2) 


Then  (rQ(t),  vQ(t))  are  given  by  the  familar  equations  of  conic  motion. 

A first  order  corrected  solution  necessary  to  account  for  the  direct  tern 
force  must  then  satisfy 

r ■=  ”r"  + <Tr  = "v“ 
o 

-*■  -t*  x*"  ^ or 

V *=  V + Ov  •=  — 

3 
r 

o 


( r - f ) 
o nr_ 


- r 


(3) 


Applying  the  conditions  (2)  leads  to  the  equations  defining  the  corrections 
6 r = 6 v 


(4) 


where  R = r (t)  - r (t)  is 
o m 

to  the  perturbing  mass. 


the  position  vector  of  the  spacecraft  with  respect 


One  further  assumption  enables  one  to  solve  in  closed  form  the  perturbations 
produced  by  the  third  mass.  Generally  R (t)  and  R (t)  are  nearly  linear 
functions  of  time.  Therefore  supjJose  ^tha  t the  initial  and  final  value;;  ni 
these  variables  are  known  to  be  R^  , , R^  over  the  interval  At. 
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Introduce  the  definitions 

As 
Ar 
<R> 


R2  - R, 

R2  - R1 


(not  A R ) 


h (Rx  + R2) 


A 

Ar 


r 


(5) 


Then  the  equation  defining  the  velocity  perturbation  would  be 


- fl 


a_+_b_t 
(c  + d t)~ 


R. 


c - R. 


££  d 

At 


Ar 

At 


(6) 


It  is  more  convenient  however  to  transform  from  time  t to  position 
magnitude  p as  the  independent  variable.  This  may  be  done  since  the 
position  magnitude  is  assumed  to  be  linear  in  time  with  p *=  AR  . 

At 

According  to  the  assumptions,  the  position  vector  R is  a linear  function 
of  p also 


R = A + B p 


(7) 


Since  R ( p ) 


R^  and  R ( p ) = R^ , the  constants  are 


A 


t*  _ AR  r 
R1  AR  R1 


AR 

AR 


R R A 
-i— 2.  AR 
Ar 


(8) 


In  terms  of  p the  equations  defining  the  perturbations  may  be  written 
(with  primes  indicating  differentiation  with  respect  to  p ) 


&r' 


5v  1 


At 

AR 


6 v 


V At  A + B P 
AR  n 3 


(9) 


These  equations  are  easily  integrated  to  determine  the  perturbations  caused 
as  the  spacecraft  moves  from  R^  to  R^  relative  to  the  perturbative  body: 
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6 v 


AR 


A + B p 
„3 


dp 


//At 

t ( i - i ) 

+ 

p 

\ 

p 
1 

AR 

2 v Rl2/ 

VJ 

//At 

V2ar 


A ^ 

<R>  AR  - AR 


(10) 


6 r 


dp 


2 

- i£At 
Ar 


1 A_r  + Ar 

2 ri  Ar2 


(ID 


PERHEL  calls  BATCON  for  the  generation  of  the  uncorrected  heliocentric 
conic,  computes  the  initial  and  final  positions  of  the  spacecraft  relative 
to  each  of  the  launch  and  target  planets,  and  computes  the  perturbations 
based  on  equations  (10)  and  (11)  above. 
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PERHEL  Flow  Chart 


ENTER 


Call  BATCON  to  propagate  state 
over  At  as  heliocentric  conic 


IB  = IB  + 1 


Compute  initial  and  final  relative 
position  of  S/C  to  body  IB 


Compute  perturbations  of  IB  body 


IB  = ? 


Add  perturbations  of  launch  and 
target  bodies  to  conic  final  state 


RETURN 
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PLND  Analysis 

The  nonlinear  equations  of  motion  of  the  spacecraft  can  be  written 
symbolically  as 


x = ?(x,  e(t)  , t) 


(1) 


where  x is  the  spacecraft  position/velocity  state  and  e(t)  is  a 
vector  composed  of  the  six  orbital  elements  a,  e,  i,  ft,  to,  and  M 
of  the  target  planet.  The  motion  of  the  spacecraft  is,  of  course, 
dependent  on  the  positions  of  other  celestial  bodies,  but  this 
dependency  need  not  be  explicitly  stated  for  the  purposes  of  this 
analysis . 


Suppose  we  wish  to  use  numerical  differencing  to  compute  those 


columns  of  0 , 

xx 

s 


e 


and  0 associated  with  target  planet  ephem- 


xu'  xw 

eris  biases  included  in  the  augmented  state  vector  over  the  time 


interval  [tk_1>  tfc] 


Let  t 


j(V 


t^_  ) represent  the  column  associ- 


ated with  the  j-th  ephermeris  bias.  We  assume  we  have  available 
the  nominal  states  x*(tk_^)  and  x*(tk),  which,  of  course,  were  ob- 
tained by  numerically  solving  equation  (1)  using  nominal  e(t).  To 
obtain  ^.(t.  , t,  ,),  we  increment  the  j-th  orbital  element  by  the 
pertinent  numerical  differencing  factor  Ae^  and  numerically  inte- 
grate equation  (1)  over  the  interval  [tk_^»  t^]  to  obtain  the  new 

spacecraft  state  x.(t,),  where  the  j-subscript  on  the  spacecraft 

J k 

state  indicates  that  it  was  obtained  by  incrementing  the  j-th  or- 
bital element.  Then 


W W - J — sr 


(2) 


Ephemeris  biases  are  defined  as  biases  of  the  basic  set  of  orbital 
elements  a,  e,  i,  ft,  cu,  and  M.  However  the  ephemeris  constants  of 
a,  e,  i,  ft,  u,  and  M for  the  planets  and  a,  e,  i,  ft,  S,  and  L for 
the  moon  are  stored  in  the  program.  Thus  to  increment  certain  of 
the  basic  elements,  we  must  increment  certain  combinations  of  the 
stored  ephemeris  constants. 
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The  elements  to  and  M are  related  to  the  longitude  of  perihelion  to 
and  the  mean  longitude  L as  follows: 


to  = to  - ft 


M = L - £ 


Thus,  to  increment  ft  by  Aft  without  changing  the  other  five  basic 
elements  requires  that  we  also  increment  o>  by  Aft  for  the  case  of  a 
planet,  and  both  to  and  L by  Aft  for  the  case  of  the  moon.  To  in- 
crement to  by  Ato  we  simply  increment  to  by  Ato  for  a planet,  while 
for  the  moon  we  must  increment  both  6}  and  L by  Ato.  To  increment 
M by  AM  for  the  moon  we  simply  increment  L by  AM. 

In  the  PLND  flow  chart  we  employ  the  following  definition: 


P 


j 
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PLND  Flow  Chart 


PLND-4 
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POICOM  Analysis 

Subroutine  POICOM  computes  the  target  condition  covariance  wt  after  a guidance 

+ ^ 

correction,  the  projection  of  W.  into  the  impact  plane,  and  the  probability  of 
impact  of  the  spacecraft  with  the  target  planet. 


The  target  condition  covariance  matrix  is  defined  as 

W+  = T).  (P.“  + MQ.MT)  771 
J I k J J 


where  V.  is  the  variation  matrix  for  the  appropriate  guidance  policy,  P^ 

is  the  knowledge  covariance  prior  to  the  guidance  correction,  is  the 
execution  error  covariance,  and  M is  defined  as  the  following  6x3  matrix: 


M 


o ! 

. i 


Before  the  probability+of  impact  can  be  computed,  it  is  necessary  to  compute 
the  projections^  of  into  the  impact  plane.  The  covar iance_/\_.  is  computed 

as  follows  for  each  of  the  three  available  midcourse  guidance  policies. 

a.  Fixed-time-of-arrival : 

+ T 

A . “Aw.  A 

J J 

where  transformation  A is  defined  in  the  subroutine  BIAIM  analysis. 

b.  Two-variable  B-plane: 

A,  = W+ 
i J 

c.  Three-variable  B-plane: 


l 

o 


0 

1 


0 

0 


w, 


1 

0 

0 


0 

1 

0 
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Assuming  the  probability  density  function  associated  with_/\_j  is  Gaussian 

and  nearly  constant  over  the  target  planet  capture  area  permits  us  to 
compute  the  probability  of  impact  using  the  equation 


POI  =7TR2 
c 


P 


where  R is  the  target  planet  capture  radius  and  p is  the  Gaussian  probability 
density  function  evaluated  at  the  target  planet  center  and  given  by 


P 


where  [A  is  the  aimpoint  in  the  impact  plane. 
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POICOM  Flow  Chart 
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PRED  Analysis 

Subroutine  PRED  executes  a prediction  event  in  the  error  analysis/ 
generalized  covariance  analysis  program.  Subroutine  PRED  differs 
from  subroutine  PRESIM  in  three  respects.  First,  the  propagated 
knowledge  covariance  matrix  partitions  are  based  on  the  (most 
recent)  targeted  nominal,  rather  than  on  the  most  recent  nominal 
as  in  PRESIM.  Second,  estimated  position/velocity  deviations  are 
not  propagated  in  PRED  since  estimates  are  processed  only  in  the 
simulation  program  and  not  in  the  error  analysis  program.  And 
third,  subroutine  PRED  treats  both  assumed  and  actual  knowledge  co- 
variance  matrix  partitions,  whereas  subroutine  PRESIM  treats  only 
assumed  knowledge  covariance  matrix  partitions.  Subroutine  PRED 
uses  the  propagation  equations  in  subroutine  GNAVM  to  propagate 
both  assumed  and  actual  covariances. 

A flow  chart  for  PRED  is  not  presented  here  because  of  its  simi- 
larity to  the  PRESIM  flow  chart  (see  PRESIM  for  further  details) . 
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PRELIM  Analysis 

PRELIM  is  responsible  for  the  preliminary  work  required  by  NOMNAL  including 
the  initialization  of  variables,  the  reading  of  input,  and  the  computation 
of  zero  iterate  values  for  initial  time,  position,  and  velocity  if  necessary. 

On  the  first  call  to  PRELIM,  PRELIM  presets  constants  to  be  used  on  the 
entire  series  of  runs.  These  constants  include  the  double  precision  numbers 
and  the  launch  profile  parameters.  On  subsequent  calls  these  variables 
are- not  reset . 

PRELIM  then  presets  constants  for  individual  runs.  These  constants  presently 
include  most  of  the  guidance  event  parameters.  The  user  may  easily  change 
the  two  sets  of  constants  for  his  particular  needs. 

PRELIM  then  accepts  the  input  data.  It  reads  data  in  the  NAMELIST  format. 

Target  times  must  be  read  in  as  calendar  dates.  PRELIM  next  converts  those 
to  Julian  date  referenced  1900  and  stores  the  converted  values  in  the  TAR 
array . 

If  the  flag  IZERO  is  nonzero,  ZERIT  is  called  for  the  computation  of  the 
zero  iterate  values  of  initial  time,  position,  and  velocity.  ZERIT  in  turn 
calls  HELIO  for  interplanetary  trajectories  and  LUNA  for  lunar  trajectories. 

PRELIM  then  converts  guidance  event  times  referenced  to  initial  time  to 
calendar  data  and  converts  times  read  in  as  calendar  dates  to  times  ref- 
erenced to  the  initial  time.  When  the  latter  is  done,  it  sets  K.TIM  to 
acknowledge  that  conversion. 

Finally  PRELIM  records  all  pertinent  data. 
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PREPUL  Analysis 


PREPUL  is  responsible  for  performing  the  preliminary  computations  required 
for  the  pulsing  arc  model. 

PREPUL  first  determines  the  nominal  pulsing  arc.  Let  the  following  defin- 
itions be  made: 


T 

m 


At 


Av 


magnitude  of  pulsing  engine  thrust 
nominal  mass  of  spacecraft 
duration  of  single  pulse 
time  interval  between  pulses 

total  velocity  increment  to  be  added 


The  velocity  increment  imparted  by  a single  pulse  is 


A v 

i 


T At 

m 


The  number  of  pulses  required  is  then 


(1) 


N 

P 


1 


(2) 


where  denotes  the  greatest  integer  function.  The  magnitude  of  the 

final  pulse  must  be  set  to 


Avf  = Av  - (Np  - 1)  Av^ 

The  vector  nominal  pulse  and  final  pulse  are  therefore  given  by 

Av  = Av 

t i Av 


*T — a Av 
Avf  ■ Avf  AV 


The  duration  of  the  pulsing  arc  is  then  given  by 


AT  = (N  - 1)  At 
P i 


(3) 


(4) 


(5) 


Later  computations  require  time  histories  of  the  position  vectors  of  the 
launch  and  target  bodies.  An  efficient  means  of  obtaining  this  involves 
the  f and  g series.  Given  the  state  rQ,  vq  of  body  moving  in  a conic 

section  about  a central  body  of  gravitational  constant  n , the  position 
vector  as  a function  of  t measured  from  the  initial  time  is  given  by 

r(t)  *>  f(t)  "r"  + g(t)  v”  (6) 

o o 
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where 


f(t) 


fk  C 


14  (t) 


k=0 


8k  fc 


k=l 


(7) 


The  constants  f , g are  computed  in  PREPUL  as 
k k 
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Reference:  Baker,  R.  M.  L.  and  Makemson,  M.  W.,  An  Introduction  to 

Astrodynamics , Academic  Press,  New  York,  1967. 
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PREPUL- 3 


PREPUL  Flow  Chart 


V 


PRES  I M - 1 


PRESIM  Analysis 

Subroutine  PRESIM  executes  a prediction  event  in  the  simulation 
program  SIMUL.  At  a prediction  event,  the  knowledge  covariance 
partitions,  and  the  estimated  pos Ltion/veloci ty  deviations  from 
the  most  recent  nominal  trajectory  are  propagated  forward  to  t^, 

the  time  to  which  the  prediction  is  to  be  made.  The  knowledge  co- 
variance  partitions  are  propagated  using  the  prediction  equations 
found  in  the  NAVM  Analysis  section.  The  estimate  is  propagated 
using  the  equation 

6X  = $ (t  , t)  SX.  + 6 (t  , t.)  <5X 
P P J xx  p J s 

® J 


where  4>  and  0 are  the  state  transition  matrix  partitions  over 
xx 

s 

the  time  interval  [t.,  t ]. 

j P 


The  position  and  velocity  partitions  of  the  propagated  knowledge 
covariance  matrix  are  diagonalized  at  time  t and  the  eigenvalues, 

eigenvectors,  and  hyperellipsoids  are  computed. 


If  t occurs  within  the  target  planet  sphere  of  influence,  the 

Cartesian  position/velocity  covariance  matrix  is  transformed  to 
a B-plane  parameter  covariance  matrix.  The  B-plane  parameters  are 
B*T,  B°R,  time-of-f light,  S-R,  S’T,  and  C^* 
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PRESIM-2 


PRESIM  Flow  Chart 


330 


PRESIM-3 


330-1 


PR0BE-1 


PR0BE  Analysis 


Subroutine  PR0BE  controls  the  execution  of  both  main  probe 
and  miniprobe  release  events.  When  a probe  release  event  occurs, 
PR0BE  saves  all  states,  covariance  matrices,  etc  relating  to  the 
bus  and  initializes  all  states,  covariance  matrices,  etc  for  the 
probe  under  consideration.  The  probe  state  at  release  is  then 
propagated  forward  to  entry,  along  with  the  probe  control  covar- 
iance matrix  partitions  to  obtain  the  probe  state  and  control 
dispersions  at  entry.  Next,  the  probe  is  tracked  from  release 
to  entry  and  probe  knowledge  covariance  matrix  partitions  are  pro- 
pagated and  updated  accordingly. 


Let  tj  be  the  time  of  probe  release  and  let  X^  denote  the 

nominal  bus  state  at  release.  Denote  all  main  probe  quantities 
with  a superscript  zero,  and  all  miniprobe  quantities  with  a 
superscript  i (for  the  ith  miniprobe  where  i = 1,  2,  3).  Then, 
following  release,  the  probe  states  are  given  by 


(1) 

(2) 


,(i) 


where  AV'  is  the  velocity  increment  imparted  to  the  ith  mini- 


j 


(i) 


probe  by  the  spin  release  at  t ^ . The  velocity  increment  AV^ 
the  miniprobe  release  controls  are  used  in  subroutine  MINIQ  to 


and 


n(i) 


associated  with 


compute  the  execution  error  covariance  matrix  Q^' 

the  spin  release  of  the  ith  miniprobe.  Denote  the  bus  position/ 
velocity  knowledge  and  control  covariance  matrices  at  release  by 

P,  and  P , respectively.  Then,  immediately  following  release, 
k • c * 

3 j 

the  probe  position/velocity  knowledge  and  control  covariance  matrices 
are  given  by 


p°  = p 
k.  k. 

J J 

(3) 

P°  = P 

P P 

(4) 

j j 

P«> , P + Lo!  o_] 

ki  kj  o]  s(i> 

L 1 3 J 

(5) 
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• (6) 

cj  j 

The  above  probe  control  matrices,  along  with  all  related 
partitions,  are  propagated  forward  to  entry  time  t^  using  the  pro- 
pagation equations  appearing  in  subroutine  GNAVM  to  obtain  the 
probe  entry  dispersions.  Beginning  with  the  above  knowledge 
covariance  matrix  of  the  probe  under  consideration  and  all  re- 
lated partitions,  the  probe  knowledge  covariance  matrix  partitions 
are  propagated  and  updated  as  each  probe  measurement  is  processed 
using  the  update  equations  appearing  in  subroutine  GNAVM. 
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PR0BE  Flow  Chart 


PR0BE-3 


330-4 


PR0BE-4 


330-5 


Define  probe  state  at  tk 


Call  SCHED  to  obtain  the 
time  t^j  and  code  of  the 

next  measurement 


Define  time  interval  At  = t. 


gm 


PR0BE-6 
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PR0BE-7 


330-8 


PR0BE-8 


Update  the  mini  probe  knowledge 
and  control  covariance  matrix 
partitions  immediately  after 
release 
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PR0BS-1 


PR0BS  Analysis 

Subroutine  PR0BS  controls  the  execution  of  both  main  probe  and 
miniprobe  release  events  in  the  simulation  program  S1MUL.  When  a 
probe  release  event  occurs,  PR0BS  saves  all  nominal  and  actual 
states,  deviation  estimates,  covariance  matrices,  etc  relating  to 
the  bus  and  initializes  all  nominal  and  actual  states,  deviation 
estimates,  covariance  matrices,  etc  for  the  probe  under  considera- 
tion. The  probe  state  at  release  is  the  propagated  forward  to  en- 
try, along  with  the  probe  control  covariance  matrix  partitions,  to 
obtain  the  probe  state  and  control  dispersions  at  entry.  Next  the 
probe  is  tracked  from  release  to  entry  and  probe  knowledge  covari- 
ance matrix  partitions  and  deviation  estimates  are  propagated  and 
updated  accordingly. 

Let  t denote  the  time  of  probe  release.  Denote  the  bus  tar- 
geted nominal  and  most  recent  nominal  states  at  release  by  X^  and 
Xj , respectively.  Denote  actual  and  estimated  deviations  of  the 
bus  state  from  the  most  recent  nominal  by  6X_.  and  6X^ , respectively. 

All  main  probe  quantities  will  be  denoted  with  a superscript  zero 
and  all  miniprobe  quantities  with  a superscript  i (for  the  ith 
miniprobe,  where  i = 1,2,3).  Then  following  release,  the  probe 
nominal  states  are  given  by 


x°  = 
xj 

5i 

(i) 

x°  = 

3 

(2) 

+ 5X. 
J 

* hr. 

(3) 

x1  = 
Xj 

x1 

j 

(A) 

where  AV . is  the  velocity  increment  imparted  to  the  ith  miniprobe 
2 i 

by  the  spin-release  at  t . The  velocity  increment  AV^  and  the 

miniprobe  release  controls  are  used  in  subroutine  MINIQ  to  compute 

the  execution  error  covariance  matrix  and  the  actual  execution 

i J 

6AV . . 
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The  actual  and  estimated  deviations  of  the  probe  states  from  the 
most  recent  nominals  are  given  by 


(5) 


6X°  = <5X 

j : 


(6) 


(7) 


6X1 

J 


6ft.  + 

3 


(8) 


Denote  the  bus  position/velocity  knowledge  and  control  covariance 
matrices  at  release  by  and  P^  , respectively.  Then,  immediately 

1 Cj 

following  release,  the  probe  position/velocity  knowledge  and  con- 
trol covariance  matrices  are  given  by 


P°  = P 
K.  K. 

J J 


(9) 


P°  = P 
c . c . 

3 3 


(10) 


V " PK.  + 

3 3 


0 I 0 

I _i“ 
0 ,Qj 


(ii) 


PC  = PK 
j 3 


(12) 


The  above  probe  control  covariance  matrices,  along  with  all  re- 
lated partitions,  are  propagated  forward  to  entry  time  t£  using  the 

propagation  equations  appearing  in  subroutine  NAVM  to  obtain  the 
probe  entry  dispersions.  Beginning  with  the  above  knowledge  co- 
variance  matrix  of  the  probe  under  consideration  and  all  related 
partitions,  the  probe  knowledge  covariance  matrix  partitions  are 
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PR0BS-3 


propagated  and  updated  as  each  probe  measurement  is  processed  using 
the  equations  appearing  in  subroutine  NAVM.  The  probe  estimates 
are  propagated  and  updated  using  the  equations  appearing  in  sub- 
routine SIMUL. 

A flow  chart  for  subroutine  PR0BS  is  not  presented  since  it  would 
be  quite  similar  to  the  flow  chart  for  subroutine  PR0BE  (see  sub- 
routine PR0BE  for  details) . 
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PRESIM-3 
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PSIM  Analysis 


Subroutine  PSIM  controls  the  computation  of  each  partition  appearing 
in  the  augmented  state  transition  matrix 


$ (k+l,k)  = 


$(k+l,k)  0 (k+l,k)  6 (k+l,k) 


0 

0 

0 

0 


xx 


XU 


I 

0 

0 

0 


0 

I 

0 

0 


0 

0 

0 

I 

0 


0 (k+l,k) 

xw 


0 

0 

0 

I 


The  first  part  of  the  subroutine  deals  solely  with  the  computation 
of  $(k+l,k)  by  one  of  the  three  techniques  — analytical  patched 
conic,  analytical  virtual  mass,  or  numerical  differencing.  If  an 
analytical  technique  is  selected  for  computing  $(k+l,k)  over  an 
interval  of  time  greater  than  the  maximum  time  interval  for  which 
the  analytical  technique  is  considered  valid,  we  compute  $(k+l,k) 
using  numerical  differencing  or  by  cascading  Danby  matrizants. 

The  remaining  partitions,  0 , 0 , and  6 , are  always  computed 

s 

by  numerical  differencing.  Columns  in  these  partitions  associated 
with  target  planet  gravitational  constant  or  orbital  elements  are 
computed  only  if  the  spacecraft  is  within  six  times  the  sphere  of 
influence  of  the  target  planet  at  Otherwise,  these  columns 

are  set  to  zero.  J 
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PS IM  Flow  Chart 
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PSIM-3 
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PULC0V  Analysis 


PULC0V  processes  the  control  covariance  through  the  pulsing  arc  to 
determine  a measure  of  the  probabilistic  deviation  of  the  corrected 
trajectory  from  the  desired  trajectory  resulting  from  execution  errors. 


The  pulsing  arc  itself 
Av^  and  a final  pulse 


is  computed  in  PREPUL. 
St  satisfying 


It  consists  of  N -1  pulses 
P 


(N  -1)  Av  + Avf  = Av  (1) 

P i f 


where  Av  is  the  equivalent  single  impulse.  The  pulses  are  separated  by 

a time  interval  At  . The  duration  of  the  entire  sequence  of  pulses  is 

i 

given  by  AT  = (N  -1)  At  . 

P i 

PULC0V  must  compute  the  execution  error  matrices  Q,  corresponding  to 
the  nominal  pulse  Av.  and  the  final  pulse  Av^  respectively.  The  error 
model  for  the  engine  is  defined  by  the  input  specifications 


proportionality  error 
resolution  error 
first  pointing  error 
second  pointing  error 


The  execution  error  matrix  measuring  the  probabilistic  deviation  of  the 
actual  velocity  increment  from  the  desired  velocity  increment  is  computed 
by  QC0MP. 

The  exact  equations  defining  the  propagation  of  the  covariance  matrix  are 
recursive  in  nature.  If  FT  is  the  control  covariance  immediately  after 
th  k 

the  k pulse,  the  covariance  will  propagate  to  the  time  of  the  next  pulse 

t by  the  formula 

k+1 

+ T 

P = <P  p d>  ( o'* 

k+1  k+1  ,k  k k+l,k  Kl) 

where  <f>  is  the  6x6  state  transition  matrix  relating  perturbations  at 

K.  i 1 j K 

t to  perturbations  at  t . Adding  the  pulse  at  t expands  the 

K“r  1 k,  k+1 

covariance  by 
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+ 

P 

k+1 


P~  + 
k+] 


0 1 


0 

Q 


(3) 


where 

Q 

is 

To  start 

the 

given 

by 

set  equal  either  to  the  nominal  or  llnal 
process  the  control  covariance  following 


form  of  Q . 
the  first  pulse 


is 

(4) 


For  efficiency  one  simplification  is  made  in  the  process.  Instead  of 
recomputing  the  state  transition  matrix  over  each  interval,  the  value  of 
that  matrix  is  held  constant  at  the  value  corresponding  to  the  "average 
interval".  To  explain  this,  let  the  state  of  the  spacecraft  at  the  time 
tQ  of  the  impulsive  Av  computation  be  denoted  r'0,  "v  . Then  the 

"average  interval"  is  defined  to  be  the  perturbed  heliocentric  trajectory 

(PERHEL)  resulting  from  the  propagation  of  the  state  ( r*  , V + ^ Av  ) 

o o 

over  the  interval  ( t , t + At  ) . 

o’  o i' 


The  constant  state  transition  matrix  <t>  is  computed  by  numerical  differ- 
encing. The  initial  state  ( ~r^,  ^ Av  ) is  first  propagated  over 

the  At,  time  interval  (using  PERHEL)  resulting  in  the  state  ( ’r*’  , "\f  ) 

1 f f 

Then  the  x-component  of  initial  position  is  perturbed  by  Ax,  leading  to 

a final  state  of  ( 'r'  , "v*  ) upon  propagation.  The  first  column  of  the 

matrix  is  then  computed  by 


1 


(5) 


The  other  columns  of 
remaining  components 


are  computed  by  similar  computations  using 
of  position  and  velocity  (y,  z,  x,  y,  z)  . 


the 
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PULSEX-1 


PULSEX  Analysis 


PULSEX  is  responsible  for  the  actual  execution^ of  the  pulsing  arc.  Exper- 
iments have  shown  that  adding  an  impulsive  Av  at  time  t may  be  approx- 
imated quite  closely  by  centering  an  equivalent  sequence  of  smaller  impulses 
about  the  nominal  time  t . 


This  equivalent  sequence  of  thrusts  is  computed  by  PREPUL. 
N - 1 pulses  Av  and  a final  pulse  Av  satisfying 

rv  * J -C 


It  consists  of 


(N 

P 


l)  Av.  + 


(1) 


The  pulses  are  separated  by  a time  interval 
entire  sequence  of  pulses  is  given  by  AT  = 


The  duration  of  the 
1)  Ati. 


For  efficiency  the  perturbed  heliocentric  conic  propagator  PERHEL  is  used 
to  propagate  the  trajectory  between  pulses.  PERHEL  requires  the  positions 
of  the  launch  and  target  bodies  at  the  beginning  and  end  of  each  propagation 
interval.  PREPUL  stores  the  position  and  velocity  of  the  launch  and  target 
bodies  at  the  reference  time  t : (~rT_,  "v  ) and  "vl-  ) and 

O i-*0  Lv  IvJ  J-v/ 


stores  the  constants  of  the  f and  g series  for  those  states 

f , g , k=l,6).  The  position  of  the  launch  body  at  some  time 
Tk  Tk 


(f..  > §T1  > 

Lk  Lk 
t relative 


to  the  reference  time  t is  then  given  by 

o 


r 

L 


(t) 


£l  (t) 


r + 
LO 


(t)  v 


LO 


where 


£L(t) 


G5 


6 


£ 

k<=0 


f 

Lk 


t 


k 


g (t)  = £ g tk 

L k=l  Lk 


(2) 


(3) 


with  similar  equations  holding  for  the  target  body. 

The  procedure  of  PULSEX  is  straightforward.  The  positions  of  the  launch 
and  target  bodies  are  computed  at  the  time  the  pulsing  arc  should  begin: 
tB  = tQ  - AT/2.  PERHEL  is  then  called  to  propagate  the  spacecraft  from  t 

backwards  to  t^  . The  actual  pulsing  arc  cycle  is  now  entered.  The  nominal 

velocity  increment  Av_^  is  added  to  the  current  velocity  impulsively 

v = v + Av,  (4) 
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and  the  resulting  state  ( r,  v ) is  propagated  forward  over  the  time 
interval  by  PERHEL.  Another  pulse  is  added  and  the  process  repeated 

until  N - 1 pulses  have  been  added.  Finally  a pulse  of  Av  is  added. 
P * 

Two  options  are  now  permitted.  If  IRE  = 0 , the  final  state  is  not 

altered  (NOMNAL) . If  IRE  = 1,  the  final  state  is  propagated  backwards 

back  to  t for  use  in  ERRAN  and  SIMUL. 
o 

Finally  CAREL  is  called  to  compute  the  conic  elements  of  the  final  state. 
For  comparison  purposes,  the  impulsive  Av  is  added  to  the  state  at  t , 

propagated  to  the  final  time  t^,  *=  t + AT/2  by  PERHEL,  and  those  elements 
computed . 
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PULSEX  Flow  Chart 


PULS EX- 3 


ENTER 


Propagate  launch  and  target  bodies 
to  start  of  pulsing  arc  "r  , 


Propagate  state  of  S/C  back  to  start 

of  pulsing  arc  to  get  r , v . 

St  or 


I PUL  *=  I PUL  + 1 


I PUL  : NPUL 
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QC0MP  Analysis 


Subroutine  QC0MP  computes  the  execution  error  covariance  matrix  Q . for 

a velocity  correction  Av  = (Av  . Av  . AV  ) occurring  at  time  t.  . If 

x v z J 


x y z 
the  execution  error  is  assumed  to  have  form 


6 Av  = kAv  + s^  + <5Av  . 


Av 


pointing 


where  k is  the  proportionality  error  and  s is  the  resolution  error, 
then  the  elements  of  the  matrix  are  given  by 
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where  V = Avx  + AVy  , P = P +AV?  , and  ff  2 , O _ 2 , , 


and 


2 " ' - s k 

°6a  are  the  varian(?es  associated  with  the  resolution,  proportionality,  and 

two  pointing  errors,  respectively. 
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QUASI  Analysis 

At  a quasi-linear  filtering  event  the  most  recent  nominal  trajectory  is 
updated  by  using  the  most  recent  state  deviation  estimate.  If  X^  is  the 

most  recent  nominal  position/velocity  state  immediately  preceding  the  event 

A — 

at  time  t.  , and  if  iX^  is  the  position/velocity  deviation  estimate, 

then  immediately  following  the  quasi-linear  filtering  event,  the  most  recent 
nominal  position/velocity  state  is  given  by 

/%/  r\j  h .A  — 

X - X + 5X 

J J j 

The  estimated  and  actual  deviations  from  the  most  recent  nominal  trajectory 
must  also  be  updated: 

~ + 

&X  =0 
j 

~ + — X - 

sx  ■=  ax.  - ax 

j J j 

A quasi-linear  filtering  event  in  no  way  alters  the  knowledge  and  control 

uncertainties  at  time  t.  . Thus  knowledge  covariance  P and  control 

1 • 

J 

covariance  P remain  constant  across  a quasi-linear  filtering  event. 

j 

Furthermore,  since__no  velocity  correction  is  performed,  the  (most  recent) 
targeted  nominal  X^  is  unchanged.  Neither  is  the  solve- for  parameter 

state  updated  at  a quasi-linear  filtering  event. 
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QUASI- 2 


QUASI  Flow  Chart 
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RNUM  Analysis 


Function  subprogram  RNUM  supplies  random  numbers  on  a normal  distribution 
with  near  zero  and  standard  deviation  a . 

Twelve  random  numbers  between  0 and  1 are  computed,  which  are  then 

used  to  compute  the  returned  random  number  RNUM  using  the  following 
equation: 


RNUM 


I 


a 
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SERIE  Analysis 


SERIE  compute s the  transcendental  functions  S(x)  and  C(x)  used  in 
the  ELITE  program  in  ttie  solution  of  Lambert's  theorem. 

The  functions  S(x)  and  C(x)  are  defined  by 


S (x) 


x > 0 


sinh  \f-x  - \/-x 


x < 0 


1 

6 


x - 0 


C(x) 


x > 0 


cosh 


-x 


X<  0 


j. 

2 


x 0 


(1) 


(2) 


For  small  values  of  | x | the  Taylor  series  expansions  are  used 

2 


S(x)  = i 


1 

3! 


x + x 


4! 


5! 


+ . . . 


C(x)  = i 


l 

2! 


x + x 


3! 


4 


+ . . . 


(3) 
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SETEVN  Analysis 

Before  executing  any  event  in  the  error  analysis /generalized  co- 
variance  analysis  program  subroutine  SETEVN  is  called  to  perform 
a series  of  computations  that  are  common  to  all  events.  Subroutine 
SETEVN  computes  the  targeted  nominal  trajectory  at  t ^ and  propagates 

the  assumed  and  actual  knowledge  covariance  partitions  at  tjc_^  — 

the  time  of  the  previous  event  or  measurement  — forward  to  time 
t.  using  the  propagation  equations  found  in  subroutine  GNAVM.  The 

actual  estimation  error  means  are  also  propagated  forward  to  t_. 

using  the  propagation  equations  found  in  subroutine  MEAN. 

For  any  event  other  than  a prediction  event,  subroutine  SETEVN  also 
computes  eigenvalues,  eigenvectors,  and  hyperellipsoids  of  the 
position  and  velocity  partitions  of  the  assumed  and  actual  know- 
ledge covariance  at  t . . 
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SETEVN  Flow  Chart 
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SETEVS  Analysis 


Prior  to  executing  any  event  in  the  simulation  mode,  subroutine  SETEVS  is 

called  to  perform  a series  of  computations  which  are  common  to  all  events. 

After  computing  the  targeted  nominal  and  most  recent  nominal  states  at 

t lie  time  of  the  event  t.  , knowledge  covariance  partitions  are  propagated 

forward  to  time  t.  frofln  time  t,  , of  the  previous  event  or  measurement 

J k- 1 

using  the  prediction  equations  found  in  the  NAVM  Analysis  section.  The 
actual  trajectory  state  at  t is  computed  using 


= Z 


+ to 


where  Z.  is  the  actual  trajectory  state  assuming  no  unmodeled  acceleration 
has  been  acting  on  the  spacecraft,  and  LO^  is  the  contribution  of  the  actual 
unmodeled  acceleration  to  the  actual  trajectory  state  at  t.  . The  actual 

and  predicted  position/velocity  deviations  from  the  most  recent  nominal  at 
tj  are  given  by 


& X 


= X . 


X . 


and 


A 

<5X 


4>(  t.,  t ) <5X  +9  (t . , t,  .)  5X 

1 k- 1 k- 1 xx  j k-1  s 


respectively,  where  <p  and  9 


xx 


are  the  state  transition  matrix  partitions 


over 


r 


For  any  event  other  than  prediction  and  quasi- linear  filtering  events,  sub- 
routines SETEVS  also  computes  eigenvalues,  eigenvectors,  and  hyperellipsoids 
of  the  position  and  velocity  partitions  of  the  knowledge  covariance  at  t.  . 


SETEVS-2 


SETEVS  Flow  Chart 
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SETEVS-4 


RETURN 
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SIMUL  Analysis 


The  primary  function  of  subroutine  SIMUL  is  to  control  the  computational 
flow  through  the  basic  cycle  (measurement  processing)  and  all  events  in 
the  simulation  mode.  Subroutine  SIMUL  also  performs  some  computations 
in  the  basic  cycle.  All  event- related  analysis  is  presented  in  the  event 
subroutines  themselves  and  will  not  be  treated  below. 

In  the  basic  cycle  the  first  task  of  SIMUL  is  to  control  the  generation 
of  targeted  nominal  and  most  recent  nominal  spacecraft  states,  X^-^  and 

— rv 

X , respectively,  at  time  t , given  states  X and  X at  time  t 
k+1  k k k k 

Then,  calling  PSIM,  DYN0S , TRAKS,  and  MEN0S,  successively,  SIMUL  controls 

the  computation  of  all  matrix  information  required  by  subroutine  NAVM  in 

order  to  compute  the  covariance  matrix  partitions  at  time  t ^ immediately 

following  the  measurement.  s'~ 

After  computing  the  actual  state  X^  at  time  t^  from 

X = X + <5X  (1) 

k k k w 

where  i X is  the  actual  spacecraft  state  deviation  from  the  most  recent 
k 

nominal,  SIMUL  controls  the  generation  of  the  actual  state  Z at  time 

k+1 

t^  before  the  effect  of  unmodeled  acceleration  has  been  added.  Then, 

having  called  DYN0S  to  compute  the  effect  of  unmodeled  acceleration  U)  , 

k+1 

SIMUL  computes  the  actual  state  and  actual  state  deviation  at  time  t : 


= Z + 


k+1  w k+1 


4Vi  ‘ \+i  - Vi  <3> 

With  both  the  most  recent  nominal  and  actual  spacecraft  states  available 
at  t,_j_-  , SIMUL  calls  TRAKS  twice  in  succession  to  compute  the  ideal 

measurements  Y and  Y , respectively,  which  would  be  made  at  each 
k+1  -k+1 

of  these  trajectory  states.  Calling  MEN0S , RNUM , and  BIAS  to  compute  the  actual 
measurement  noise  and  bias  corrupting  the  ideal  measurement  associated  with 
the  actual  state,  SIMUL  computes  the  actual  measurement  at  time  t,  ,,  using 


Y + b + 
”k+l  k+1 
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where  b^+^  anc*  ^k+l  rePresent  the  actual  measurement  bias  and  noise, 
respectively . 

All  information  required  for  computing  both  predicted  and  filtered  state 

deviations  from  the  most  recent  nominal  at  t,  . , is  now  available.  With 

k+1 

and  9 denoting  state  transition  matrix  partitions  over  the  time 

XX8 

interval  j^t^,  ^+1  1 ’ computes  the  predicted  spacecraft  state 

deviations  and  solve- for  parameter  deviations  at  t using 

K.  ' ' i. 


+ 

<5x 

sk 


k+l 


rJ 

A 

6x 


+ 


(5) 

(6) 


Prior  to  computing  filtered  deviations,  SIMUL  computes  the  measurement 
residual  from 


€ 


k+l 


Al  'A  _ 

Y ) - H ax 
k+l  k+l  k+l 


M 

k+l 


k+l 


(7) 


where  H and  M are  observation  matrix  partitions.  Filtered 
k+l  k+l 

spacecraft  state  deviations  and  solve- for  parameter  deviations  are  then 
computed  from 


AJ  1 
A + 

6x 

k+l 


a - 

<5x 

k+l 


+ K 


k+l  k+l 


A -I- 

<5*s 


k+l 


/Sf 

6x  ' + s 

sk+i 


k+l  k+l 


where  and  ^ are  the  filter  gain  constants 


(8) 

(9) 
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SXMUL  Flow  Chart 
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Define  time  interval  At  = t - t 
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Does  an  event  occur  before  t 


Call  NTMS  to  compute  state  X 
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SIMUL-6 
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SIMUL-7 
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SIMUL-8 
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STAPRL  Analysis 


The  ecliptic  components  of  the  position  and  velocity  of  a tracking  station 
relative  to  the  Earth  are  related  to  station  location  parameters  R,  9,  and 
0 through  the  following  set  of  equations: 


X = R cos  9 cos  G 
8 

Y = R cos  9 cos  € sin  G + R sin  9 sin€ 
s 

Z = -R  cos  9 sin  € sin  G + R sin  9 cos  € 
s 

X = - UR  cos  9 sin  G 
s 

Y = OIR  cos  9 cos  € cos  G 
s 

Z = - CdR  cos  9 sin  € cos  G 
s 

where  G = <fi  + CO  (t  - T) , and  T is  the  universal  time  at  some  epoch (usually 
launch  time) . 


Subroutine  STAPRL  computes  the  negative  of  the  partials  of  the  previous 
quantities  with  respect  to  the  station  location  parameters  R,  9,  and  4>  . 
These  partials  are  summarized  below: 


5R 


cos  9 co6  G 


dQ 


R sin  9 cos  G 


ex 

■ ,S|  = R cos  9 sin  G 

3 <f> 


111 

d R 


- Jjsin  € sin  9 + cos  € cos  9 sin  (Tj 


eY 

s 

6 9 
*Ys 

d<i> 


R cos  C sin  9 sin  G - R sin  f cos  9 


-R  cos  € cos  0 cos  G 


5Z 

*=  sin  e cos  9 sin  G - cos  € sin  9 

eR 
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dZ 

B 

ag 

az 

___ s 

a0 


- [R  sin  € sin  9 sin  G + R cos  e cos  0^ 


R sin  e cos  9 cos  G 


ax 
6 

aR 

ax 

s 

dQ 


•=  CJ  cos  9 sin  G 


*=  - cj R sin  9 sin  G 


ax 

s 

d(f) 


(j R cos  9 cos  G 


3Y 

2.  = - oj cos  9 cos  € cos  G 

aR 


ay 

s 

dQ 

ay 

s 

6 0 


az 


aR 


az 
8 

dQ 


(OR  cos  € sin  9 cos  G 


6>R  cos  € cos  9 sin  G 


Cj  s in  £ cos  9 cos  G 


-£*;R  sin  e sin  0 cos  G 


az 

“ - a»R  sin  € cos  0 sin  G 
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SUMP  Analysis 

Subroutine  STIMP  converts  a plane tocentric  ecliptic  state  vector 
T 

(r/v)  to  the  more  readily  targetable  impact  plane  coorinates 
B*T  and  B-R.  These  coordinates  are  preferred  as  target  variables 
for  two  basic  reasons:  (1)  they  generally  exhibit  reasonably 

linear  dependence  on  the  targeting  controls,  and  (2)  in  probe 
targeting  they  obviate  the  need  for  defining  a pseudoimpact  point 
when  the  probe  misses  the  planet  in  an  early  interation. 

The  impact  coordinates  are  defined  in  terms  of  the  direction  of 
the  trajectory  hyperbolic  excess  velocity,  v , and  the  north 
ecliptic  pole  vector,  K.  Let  00 


: V V 

(1) 

oo  00 

S X K 

||?  x K|| 

(2) 

= S_  X r 

(3) 

where  all  the  vectors  are  assumed  to  originate  at  the  planet 
center.  Thus  _T,  R and  form  a right-handed  Cartesian  frame 
with  S_  pointing  in  the  direction  of  the  hyperbolic  excess  velocity 
and  _T  lying  in  the  ecliptic  plane.  The  plane  containing  the  vector 
vector  ^T  and  R is  known  as  the  impact  plane.  J3  is  defined  as 
that  unique  vector  from  the  planet  center  to  the  point  where  the 
trajectory  asymptote  pierces  the  impact  plane.  B*T  and  B*R  are 
then  simply  the  components  of  ji  along  the  T and  R axes,  respec- 
tively. Figure  1 illustrates  all  of  these  terms  for  the  case  of 
a single  probe  trajectory. 

In  addition  to  calculating  B*T  and  B.R,  STIMP  also  makes  avail- 
able other  approach  trajectory  parameters  useful  in  the  STEAP 
auxiliary  targeting  scheme.  These  are  S^,  _T.  R,  and  j3  in  the 
inertial  ecliptic  frame  as  well  as  the  approach  hyperbola  semi- 
major axis,  a. 
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The  formulae  used  in  calculating  these  elements  are  well  known 
results  derived  in  most  engineering  treatments  of  two-body  motion 
(see,  for  example.  Ref  2).  Hence  they  will  simply  be  listed  here 
in  the  order  they  are  used.  The  standard  conic  symbolism  is  used 
throughout : 


h = 

>1 

X 

M 

(4) 

W = 

h/h 

(5) 

r = 

_r  • v/  r 

(6) 

P = 

h2/y 

(7) 

a = 

r/(2  - rv2/p) 

(8) 

e = 

yj  1 “ P/a 

(9) 

cos  0 = 

(p  - r)/er 

(10) 
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sin  0 = rh/ep  - (11) 

B =VpM  (12) 

Z = (rv  - rr)/h  (13) 

P = — cos  0 - Z sin  0 (14) 

— r — 

£ = -p  sin  0 + Z cos  0 (15) 

S = P/e  + - 1 (16) 

B = pP/e  + ^e2  - 1 (17) 

-=(s2*  “ sr  °)T/Vsi2  + s22  (18) 

S - (-S3T2-  S3T1>  S1T2  - S2Tl)T  U9) 

B.T  = B T + B2T2  (20) 

B.R  = B Rx  + B2R2  + B3R3  (21) 
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SUBS0L  Analysis 

Subroutine  SUBS0L  computes  the  transformation  from  planetocent ric 
ecliptic  coordinates  to  subsolar  planet  orbital  plane  coordinates 
for  an  arbitrary  planet.  The  subsolar  planet  orbital  plane  co- 
ordinate system  is  defined  as  the  plane toccntri c system  whose 
x-axis  points  directly  at  the  sun,  whose  z-axis  is  normal  to  the 
planet’s  orbital  plane,  and  whose  y-axis  is  normal  to  the  xz-plane 

and  lies  in  the  planet’s  orbital  plane.  In  the  figure  below  r 

and  v denote  the  position  and  velocity  vectors,  respectively,  of 

the  planet  relative  to  the  sun.  Unit  vectors  e , e , and  e are 

x y z 

aligned  with  the  axes  of  the  subsolar  planet  orbital  plane  system. 


_r 

r 


->• 

e 


->•  -»■ 
e x e 
z„  x 
s s 


->  -»■ 
r * v 

Ir  x $1 
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If  these  unit  vectors  are  referred  to  the  ecliptic  coordinate  sys- 
tem, the  coordinate  transformation  A from  pianetocent ri c ecliptic 
to  subsolar  planet  orbital  plane  coordinates  is  given  by 


-KL' 

e 

x 

s 


->T 

e 


L 


z 

s 


Thus 


-»■  -v 

x , = A x . . 

subsolar  ecliptic 


SUBS0L  Flow  Chart 
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TARGET  Analysis 

TARGET  is  responsible  for  the  control  of  any  targeting  (nonlinear  guidance) 
event.  The  targeting  is  done  either  by  the  Newton- Raphson  technique  or  by 
a steepest  descent-conjugate  gradient  algorithm,  the  method  being  specified 
by  the  user.  In  either  case  numerical  differencing  is  used  to  compute  the 
required  sensitivities. 

I.  Preliminaries 

0 

The  current  inertial  state  of  the  spacecraft  upon  entering  TARGET  is 
first  saved  (RIS=RIN)  along  with  the  original  SOI  radius  (OSPH=SPHERE)  since 
both  variables  may  be  changed  during  the  course  of  the  targeting.  Before 
exiting  from  TARGET  these  values  are  restored. 

The  index  of  the  current  event  KUR  has  been  computed  by  TRJTRY . This 
enables  the  specific  targeting  parameters  for  the  current  event  to  be  set: 

Parameter  Definition 

METHOD  Triggers  Newton  Raphson  (=0)  or  Steepest  Descent  (^0) 

technique 

MATX  Determines  whether  Newton- Raphson  matrix  is  computed 

always  (=2  ) or  only  at  low  level  (=1) 

IBAST  Determines  whether  bad  step  checks  are  made  never  (=1  ), 

high  level  only  (=2  ) or  always  ( =3  ) 

LEVELS  Number  of  integration  accuracy  levels  to  be  used 

NOPAR  Number  of  target  parameters  to  be  used 

ACC  Actual  accuracy  levels  used  in  targeting 

The  following  flags  are  then  initialized  to  zero 

Flag  Definition 

ITDS  Counter  for  steepest  descent  iterations 

LOWHI  Flag  indicating  whether  first  phase  complete  (=1)  or 

not  (=0) 

NOMORE  Flag  indicating  whether  outer  targeting  has  been  done 

(=1)  or  not  (=0) 

The  target  time  is  computed  and  using  that  time  the  transformation  matrix 
from  ecliptic  to  target  planet  equatorial  coordinates  is  calculated 

(PECEQ) . 

II.  Phase  Preparations 

TARGET  performs  the  targeting  in  one  phase  unless  targeting  to  TCA  (time 
of  closest  approach).  In  that  case  the  trajectory  is  targeted  in  two  phases: 
the  first  phase  targets  to  the  target  planet  SOI  (sphere  of  influence),  the 
second  phase  to  the  closest  approach  conditions.  IPHASE  is  the  phase  counter, 
NOPHAS  is  the  number  of  phases  needed. 
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If  all 
If  the  last 
to  a 1 . If 
set  to  1 to 


the  phases  have  been  completed,  the  program  prepares  to  exit, 
iterate  satisfied  the  target  tolerances  ITOL  will  have  been  set 
it  did  not,  ITOL  will  be  zero  and  this  requires  that  KWIT  be 
terminate  the  program  upon  return  to  the  basic  cycle. 


If  the  last  phase  has  not  yet  been  completed  TAROPT  is  now  called 
with  an  argument  1 to  compute  the  following  phase  parameters: 


Parameter 


Definition 


KEYTAR(3) 
KAXTAR(3) 
DTAR(3) 
DAUX(3) 
FAC  (3) 

ISTOP 


Vector  of  codes  of  target  parameters 
Vector  of  codes  of  auxiliary  parameters 
Vector  of  desired  values  of  target  parameters 
Vector  of  desired  values  of  auxiliary  parameters 
Weighting  factors  for  loss  function  for  auxiliary 
parameters 

Flag  indicating  integration  stopping  conditions  with 
ISTOP  = 1,2,3  indicating  fixed  final  time,  SOI,. or 
CA  encounter 


The  target  parameters  are  the  parameters  actually  desired;  the  auxiliary 
parameters  are  the  parameters  used  to  do  the  targeting.  The  target  and 
auxiliary  parameters  are  identical  except  when  i and  r^  are  targets. 

In  that  case  the  corresponding  auxiliary  parameters  are  B-T  and  B-R  which 
are  much  more  linear  variables.  The  codes  of  the  target  and  auxiliary  par- 
ameters are  as  follows: 

Code  1 2 3 4 5 6 7 8 9 10  11  12 

Parameter  TRF*  TSI  TCS  TCA  BDT  BDR  RCA  INC  SMA  XRF  YRF  ZRF 

* not  currently  available 

III.  Level  Preparations 

Within  any  phase  TARGET  operates  through  a series  of  integration 
accuracy  levels  prescribed  by  the  user.  After  completing  each  level  TARGET 
checks  to  see  if  the  maximum  number  of  levels  LEVELS  has  been  exceeded.  If 
it  has  the  program  cycles  to  the  beginning  of  the  "phase  loop"  to  go  to  the 
next  phase.  If  the  current  level  LEV  is  less  than  LEVELS  the  following 
computations  are  made. 

The  flag  ITARM  controls  whether  the  previous  targeting  matrix  is  to  be 
used  (=1)  or  whether  the  matrix  is  to  be  recomputed  (=2)  during  the  current 
level.  ITARM  is  set  according  to  the  current  values  of  MATX,  ISTART,  and 
LEV. 


The  flag  IBAD  controls  the  bad  step  logic.  If  IBAD=1  no  bad  step  check 
will  be  made  during  the  current  level;  if  IBAD=2  the  bad  step  check  will  be 
in  effect.  TARGET  sets  IBAD  according  to  the  values  of  IBAST  and  LEV. 

The  flags  ITOL,  ITER,  ITBAD  are  set  to  0 to  begin  the  iterations.  The 
allowable  iterations  NITS  and  bad  iterations  MAXBAD  are  also  set  at  this  time. 
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IV.  Iterate  Calculations 

Within  each  level  the  program  makes  one  or  more  iterations.  After 
each  iteration  the  program  updates  the  iteration  counter  ITER.  If  the 
maximum  number  of  iterations  for  this  level  NITS  has  been  exceeded,  the 
program  sets  KWIT  to  1 and  prepares  for  the  return  from  TARGET.  Otherwise 
TARGET  computes  the  target  and  auxiliary  values  corresponding  to  the 
current  iterate  values  of  state  (position  and  velocity)  RIN. 

The  integration  parameters  are  first  set.  VMP  is  then  called  to  prop- 
agate the  initial  state  to  the  final  stopping  conditions.  Checks  are  made 
to  insure  that  the  target  planet  SOI  was  intersected  if  the  stopping  con- 
ditions were  SOI  or  CA . If  it  was  not  intersected  and  this  is  the  first 
iteration,  the  "outer  targeting"  phase  is  entered  (see  below).  If  "outer 
targeting"  has  already  been  performed,  the  bad-step  check  is  entered  to 
reduce  the  previous  correction  by  REDUC. 

Otherwise  TAROPT  is  called  with  the  argument  2 to  compute  the  desired 
and  actual  target  (DTAR,  ATAR)  and  auxiliary  (DAUX,  AAUX)  parameter  values. 
The  absolute  error  in  target  values  AER  and  the  error  in  auxiliary  values 
DEV  are  then  computed. 

If  the  current  iterate  is  the  first  integration  at  the  low  level 
during  the  second  phase  of  targeting  (L0WHI=1)  TARMAX  is  now  called  to 
compute  the  phase  2 targeting  matrix.  Then  the  state  RIN  is  reset  to  the 
targeted  velocity  at  the  high  level  TVH  to  prepare  for  the  second  phase 
targeting.  The  program  then  returns  to  the  level  loop. 

Otherwise  the  program  now  checks  the  actual  target  variables  to  deter- 
mine whether  they  satisfy  the  input  tolerances  or  not. 

V.  Tolerances  Satisfied 

If  the  tolerances  are  satisfied,  the  program  first  checks  to  see  if  the 
current  targeting  phase  is  outer  targeting.  If  it  is  TARGET  restores  the 
original  target  parameters  and  initiates  the  normal  targeting  (see  Outer 
Targeting  below). 

If  the  current  targeting  is  already  normal  targeting,  TARGET  sets 
IT0L=1  to  indicate  the  satisfaction  of  the  tolerances.  If  the  problem  is 
a 2-phase  and  the  current  level  is  the  highest  level  in  phase  1 targeting, 
the  targeted  high  level  velocity  TVH=RIN  is  saved,  LOWHI  is  set  to  1 and 
the  targeted  low  level  velocity  is  recalled  RIN=TVL  for  the  construct  of 
the  phase  2 targeting  matrix.  Then  the  level  loop  is  reentered. 

VI.  Bad  Step  Reduction 

If  the  target  parameter  values  of  any  iterate  are  not:  within  the 
acceptable  tolerances  TARGET  now  assigns  a scalar  error  £ to  the  iterate 
using  the  weighting  factors  W 

£ = w - At 
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If  the  bad- step  check  is  to  be  made  on  this  iterate  the  current  error  € 
is  compared  to  the  previous  error  £ . If  £ ■*  e and  the  maximum 

p p 

number  of  bad  steps  has  not  been  exceeded,  the  previous  correction  Av 
is  reduced  by  REDUC  (usually  1/4).  The  initial  state  RIN  is  adjusted  by 
this  and  the  iterate  loop  is  reentered.  If  the  maximum  number  of  bad 
steps  has  been  made,  KWIT  is  set  to  1 and  the  preparations  for  return  are 
made . 


VII.  Generation  of  Next  Iterate 

The  correction  Av  to  any  iterate  may  be  computed  from  either  of 
two  techniques  selected  by  the  flag  METHOD.  If  METHOD  f 0,  subroutine 
DESCENT  is  called  for  the  computation  of  the  Av  by  a steepest  descent 
algorithm.  The  numerical  value  of  METHOD  determines  the  number  n of 
conjugate  gradient  steps  between  each  straight  gradient  step  where  n = 
METHOD- 1.  Thus  if  METH0D=1,  every  step  is  in  the  direction  of  the  gradient. 
But  if  METH0D=5,  four  steps  are  taken  following  the  conjugate  gradient 
direction  before  rectification  by  the  gradient  direction. 

If  METHOD=0,  the  Newton- Raphson  correction  is  used.  If  ITAEM=0,  TARMAX 
is  called  for  the  computation  of  the  targeting  matrix  0 by  numerical 
differencing.  If  any  of  the  integrations  made  in  constructing  that  matrix 
satisfy  the  tolerances  in  t > the  flag  IEND  is  set  to  1 before  returning 
to  TARGET.  Thus  a check  must  be  made  on  IEND.  If  ITARM=1  the  previous 
targeting  matrix  is  used.  The  correction  is  then  given  by 

= 0 • Act 

where  A 01  ate  the  deviations  in  the  iterate  auxiliary  values.  The  Av 
is  checked  to  insure  that  the  maximum  step  size  DVMAX  is  not  violated:  if 
it  is,  the  A v is  reduced  proportionately  to  satisfy  it.  The  next  iterate 
is  then  set  to 


( r,  v ) = ( r,  v + Av  ) 
and  the  return  is  made  to  the  iterate  loop. 

VIII.  Outer  Targeting 

Occasionally  the  zero  iterate  initial  state  leads  to  a trajectory 
missing  the  target  body  SOI.  Since  all  target  options  except  one  (targeting 
to  a specified  position,  i.e.,  KTAR  = 10,11,12)  require  the  trajectory  to 
intersect  the  target  body  SOI  steps  must  be  taken  to  correct  this. 

Let  the  initial  state  propagated  forward  lead  to  a trajectory  with  a 

closest  approach  to  the  target  body  of  r with  r r where  r 

CA  CA  ^ SI  SI 

is  the  radius  of  the  SOI. 
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Until  the  initial  trajectory  intersects  the  SOI  the  usual  targeting  can 
not  be  done.  Therefore  an  "artificial"  SOI  is  introduced  having  a radius 
of 


r = 1.2  x r 

AS  I CA 


The  initial  trajectory  obviously  intersects  the  artificial  SOI  and  hence 
may  be  targeted  to  conditions  on  the  ASOI.  If  the  target  conditions  are 
established  as  B-T  = B»R  = 0,  when  this  artificial  targeting  is  completed, 

A A 


the  refined  trajectory  will  be  headed  straight  for  the  target  body  when  it 
hits  the  ASOI.  Thus  the  refined  trajectory  should  automatically  hit  the 
normal  SOI  when  propagated  past  the  ASOI.  To  insure  that  the  time  of 
intersection  with  the  normal  SOI  is  consistent  with  the  target  time,  an 
artificial  target  time  is  also  used.  Let  the  speed  of  the  spacecraft  with 


respect  to  the  target  body  at  r be  v 

CA 


CA 


Make  the  approximation  that 


this  speed  will  be  roughly  the  same  for  the  refined  trajectory.  Then  the 
time  that  the  spacecraft  should  intersect  the  ASOI  is 


t 

AS  I 


t 

CA 


rASI 


v 


CA 


or 


t 

AS  I 


ASI 


SI 


SI 


CA 


where  the  first  formula  should  be  used  if  the  target  time  is  t or  t 

and  the  second  formula  is  used  for  t CA  CS 

SI 

Thus  when  a trajectory  is  found  which  misses  the  normal  SOI,  the  closest 

approach  state  r , v is  recorded.  The  normal  SOI  radius  is  stored  and 
CA  CA 

the  artificial  SOI  radius  given  above  is  used  in  its  place.  Target  parameters 
of  b°ta>  B°RA>  anci  fcASI  are  then  set  up  as  tlrie  targets.  When  targeting 

of  this  artificial  problem  is  complete,  the  resulting  trajectory  will  inter- 
sect the  normal  SOI  and  the  original  problem  may  be  solved. 
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Set  IBAD  flag, 


Set  other  constants  for  current  level: 
ITOL=1TER=ITBAD=0 , PERROR,  NITS,  MAXBAD 


= 1 


Set  integration  parameters:  INPR,  DELTP, 

IPRINT, ISPH, ICL, ISP2 , ICL2 , ACK , INCMT 

\ 

> 

Call  VMP  to  propagate  current  iterate  RS 

V /v 

Call  TAR0PT(2)  to  compute  desired  and 
actual  target  (DTAR,ATAR)  and  auxiliary 
(DAUX , AAUX)  parameters  and  differences 
AER(i)  = jDTAR(i)  - ATAR(i) [ 

DEV (i)  = DAUX(i)  - AAUX(i) 


Enter  "Outer  Targeting" 

Set  NOSOI  =1 
Store  original  parameters  SOI,  TOL 
Set  up  artificial  parameters  KEYTAR, 
KAXTAR,  DTAR,  DAUX,  CTOL,  ISTOP, 
ITARM,  IBAD,  NITS,  DVMAX,  PERV 
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LOWHI=? 


Call  TARMAX  for  computation  of 
low  level  phase  2 targeting  matrix 


Are  all  errors  tolerable?  \ N( 
AER(i)  < CTOL(i)  / 


TOLERANCES 


SATISFIED 


NOSOI=?  / 

^ 

t 

ITOL=l 

1 

t 

NOPHAS=?  ^ 

1 

n 

t 

<(  ISTART=?  ) 

\ 

n 

f 

v=?  N 
/ 

¥1 

- 

1 

^ 

f 

' LEV: LEVELS 
\ / 

Set  parameters  for  "Phase  2 Targeting" 
RIN=TVH,  ITARM=1,  ISTART=2, 
LEV=LEVELS= 1 , LOWHI=0 


Exit  from  "Outer  Targeting" 

Set  NOSOI  =0 
Restore  CTOL,  SPHERE 
Set  parameters  for  return  to  inner 
targeting:  LEV,  NQMORE , PERV,  DVMAX 


TVH=RIN  j RIN=TVL 
LOWHI=l , ISTART=0 
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BAD- STEP 
REDUCTION 


Compute  current  scalar  measure  of 
error  = CERROR  using  factors  FAC 
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IBAD=? 


CERROR :PERROR 


PERROR=CERROR 

FACBS=I/REDUC 


Bad-Step  Reduction 
IT  BAD=  IT  BAD4- 1 
FACBS=FACBS  • REDUC 


NEXT  ITERATE 


Cmethod=? 


[TBAD  :MAXBADS 


ITARM=? 


Call  TARMAX  for  computation 
of  targeting  matrix  PHI  for 
Newton -Raphson  procedure. 


DELTAV=DELTAV /REDUC | 
RIN=RIN  + DELTAV 


IEND= ? 


Call  DESENT  for  computation 
of  DELTAV  by  steepest  descent  or 
conjugate  gradient  technique. 


DELTAV  = PHI  * DEV 


Insure  that  each  component 
of  DELTAV  ^ DVMAX 
RIN  = RIN  + DELTAV 


NITS=? 


PREPARATIONS  FOR  RETURN 
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TARMAX  Analysis 


TARMAX  computes  the  targeting  matrix  used  by  TARGET  for  Newton- Raphson 
refinements.  The  targeting  matrix  is  computed  by  numerical  differencing. 

Let  the  current  iterate  initial  state  be  denoted  r,  v . Let  the  auxiliary 
parameters  corresponding  to  this  state  be  a . Let  the  perturbation  size 
for  the  sensitivities  be  /\ v . 


The  k-th  column  of  the  sensitivity  matrix  is  computed  as  follows, 
the  k-th  component  of  velocity  by  Av: 


v + Av 


T 


Perturb 

(1) 


Propagate  the  perturbed  initial  state  ( r4,  v-*  ) to  the  final  stopping 

P 

conditions.  Let  the  auxiliary  parameters  of  that  trajectory  be  denoted  O*. 
The  k-th  column  of  the  sensitivity  matrix  x is  then  given  by 


x 

k 


(2) 


Having  computed  all  the  columns  of  x , the  targeting  matrix  is  then  given 
by  the  inverse  of  x : 

$ = x"1  (3) 

The  targeting  matrix  then  has  the  property  that  to  obtain  a change  A°<  in 
the  nominal  auxiliary  parameters,  the  velocity  should  be  changed  by  the 
amount 


Av  = • A«* 


(4) 
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ENTER 


1 

Set  KOMP  = 0,  set  up  accuracy 
level,  perturbation  Av,  and 
save  nominal  auxiliary  values  <x  . 

_ \ 

L 

Set  up  ISP2 , ICL2  flags 
based  on  ISTOP  flag. 

\ 

f 

KOMP  = 

KOMP  + 1 

1 

<[ 

ii 

4 

+ 

Av  (KOMP) 

Call  VMP  to  integrate  tra- 
jectory to  stopping  conditions, 


Did  trajectory  miss  SOI 
and  ISTOP  ^ 1 


v^  = v~* - A v^CKOMP) 

Av  (KOMP)  = Av  (KOMP)/ 4 


Do  target  parameters  t 
satisfy  tolerances? 


Compute  KOMP  column  of  sen- 
sitivity matrix  x = <*p  ~ Q 

A v (KOMP) 


r 

A 

( B 

] 

J 

Compute  targeting 
matrix  <J>  = x~  1 


RETURN 
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TAR0PT  Analysis 

TAR0PT  is  responsible  for  computing  the  desired  and  achieved  tar- 
get parameter  values  for  all  the  targeting  subroutines.  To  add 
any  new  target  parameters,  TAR0PT  is  the  only  subroutine  that  must 
be  modified. 

The  key  variables  used  by  TAR0PT  and  their  definitions  are: 

Variable  - Definition; 

KTAR(6,10)  - Codes  of  target  parameters  of  all  targeting  event 

TAR(6,10)  - Desired  values  of  target  parameters  of  all 

targeting  events; 

KEYTAR(3)  - Codes  of  target  parameters  of  current  event; 

DTAR(3)  - Desired  values  of  target  parameters  of  current 
event; 

ATAR(3)  - Actual  values  of  target  parameters  of  current 
iterate; 

KAXTAR(3)  - Codes  of  auxiliary  parameters  of  current  iterate; 

DAUX(3)  - Desired  values  of  auxiliary  parameters  on  current 
iterate; 

AAUX(3)  - Actual  values  of  auxiliary  parameters  of  current 
iterate. 

The  available  target  parameters  and  their  codes  and  definitions  are 
tabulated. 
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Code 

Parameter 

Definition 

1 

CPS 

Time  at  probe  sphere  impact  (n-body  integration 
to  sphere  of  influence  (SOI) , conic  propagation 
to  probe-sphere) 

2 

tSI 

Time  at  SOI  of  target  body  (n-body  integration 
to  SOI) 

3 

Ccs 

Time  at  CA  (n-body  integration  to  SOI,  conic 
propagation  to  CA) 

4 

tCA 

Time  at  CA  (n-body  integration  to  CA) 

5 

B-T 

Impact  parameter  B*T 

6 

B-R 

Impact  parameter  B*R 

7 

i 

Inclination  to  target  planet  equator 

8 

rCA 

Radius  of  closest  approach  to  target  body 

9 

asi 

Semimajor  axis  of  conic  with  respect  to  target 
body 

10 

Xf 

X-component  of  final  state  (inertial  ecliptic 
system) 

11 

yf 

Y-component  of  final  state 

12 

zf 

Z-component  of  final  state 

13 

6i 

Declination  of  probe  target  point  in  planeto- 
centric  probe-sphere  coordinate  system  speci- 
fied by  IPCS 

14 

ai 

Right  ascension  of  probe  target  point  in 
planetocentric  probe-sphere  coordinate  system 
specified  by  IPCS 

15 

fcPR 

Time  at  probe-sphere  impact  (n-body  integration 
to  probe  sphere) 
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The  term  target  parameter  refers  to  a variable  with  a final  value 
that  conforms  to  a desired  value.  The  term  auxiliary  parameter 
refers  to  a variable  used  to  compute  the  progressive  corrections. 

The  target  parameters  and  auxiliary  parameters  are  identical  unless 
the  target  parameters  include  either  of  the  pairs  i and  r or  u 

LA  i 

and  6 . In  these  cases  the  more  linear  parameters  B-T  and  B°R  are 

used  as  auxiliary  targets  in  place  of  the  actual  ones.  The  desired 
values  of  the  asymptote  pierce-point  coordinates,  B^*T  and  B^'R, 

as  well  as  the  actual  values,  B^*T  and  B^'R,  are  computed  by  IMRCT 

for  each  successive  iterate  of  the  trajectory,  based  on  the  desired 
values  of  i and  r or  a and  6 . 

L/A  i JL 

TAR0PT  is  called  under  three  different  options,  which  are  distin- 
guished by  an  argument  ITAR0.  The  three  different  options  will  be 
discussed  in  order. 

TAR0PT(1)  is  called  by  TARGET  at  the  beginning  of  each  phase  to 
set  up  the  proper  variables  for  the  targeting.  The  arrays  KEYTAR, 
KAXTAR,  DTAR,  and  DAUX  are  set  to  the  current  event  values  of  KTAR 
and  TAR.  If  t or  t is  a target  parameter,  the  number  of  phases 

N0PHAS  is  set  to  2.  Then  for  the  first  phase  of  a two-phase  problem, 
the  time  target  variable  t_.  or  t„n  is  replaced  by  t„„  or  t_,„ , re- 

LA  r K Lo  l b 

spectively,  in  the  KEYTAR  and  KAXTAR  arrays.  Thus  in  the  initial 
high-speed  phase  of  a high-precision  double-phase  targeting  problem, 
integration  is  stopped  at  the  SOI  and  the  trajectory  is  extrapolated 
to  the  target  conditions  as  in  a single-phase  case.  If  i and  r 

un 

or  and  6 are  included  in  the  adtual  target  parameters,  the  cor- 
responding indices  of  the  KAXTAR  array  are  set  for  the  auxiliary 
targets  B*T  and  B-R.  TAR0PT  then  sets  up  the  integration  parameters. 

There  are  three  propagation  stop  modes.  The  first  terminates  the 
trajectory  after  a maximum  prepagation  time  interval,  At,  set  equal 
to  the  nominal  difference  between  the  target  time  t^  and  the  cur- 
rent guidance  event  time  t_: 

At  - tT  - tG  . (1) 

For  this  stopping  condition,  1ST0P  is  set  to  1.  The  second  termi- 
nation mode  stops  propagation  at  the  SOI  (or  at  impact  if  the  SOI 
radius  is  temporarily  set  to  that  of  the  probe  sphere) . This 
IST0P  = 2 mode  is  used  when  the  target  time  is  t , t , t , or  t . 

j 1 ro  r K 
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The  final  IST0P  = 3 mode  terminates  the  propagation  at  closest  ap- 
proach. It  is  used  only  when  the  target  time  is  t . In  either 

of  the  last  two  modes,  the  maximum  propagation  time  interval  is 
set  to  1.1  times  the  value  assigned  for  the  first  mode  except  when 
one  of  the  target  parameters  is  a , the  semimajor  axis  of  the 

planetocentric  conic  at  the  target  time.  In  this  case  At  is  set 
to  the  same  value  as  in  the  first  stopping  mode.  The  augmented 
propagation  interval  guarantees  that  the  trajectory  will  be  pro- 
pagated long  enough  to  reach  the  desired  targeting  termination. 

Finally  the  weighting  factors  FAC(3)  used  in  computing  the  scalar 
loss  function  are  set.  Since  the  loss  function  is  calculated 
solely  from  the  auxiliary  targets,  which  all  have  units  of  either 
length  or  time,  only  the  relative  weight  of  time  to  length  need 
be  input.  Thus  the  length  factors  are  set  to  unity  and  the  time 
factor  to  the  input  value  in  WGHTM. 

TAR0PT(2)  is  called  by  TARGET  after  integrating  each  iterate  to 
the  final  stopping  conditions.  Here  TAR0PT  performs  mainly  a book- 
keeping role.  It  must  fill  the  proper  cells  of  the  ATAR,  AAUX,  and 
DAUX  arrays  with  values  generally  computed  by  the  virtual-mass 
routines.  If  auxiliary  targeting  is  required,  both  the  actual  and 
desired  values  of  the  B-plane  coordinates  are  computed  by  calling 
IMPCT. 

Since  TAR0PT(3)  is  called  by  TARMAX  and  DESENT  after  integrating 
each  perturbed  trajectory  to  compute  the  perturbed  values  of  the 
auxiliary  parameters,  the  desired  values  of  DAUX  need  not  be  com- 
puted at  this  time.  If  auxiliary  targeting  is  in  process,  the  ac- 
tual values  of  the  B-plane  coordinates,  B^*T  and  B^*R,  are  computed 

by  a call  to  IMPCT.  Once  again  this  task  is  simply  a bookkeeping 
job  to  store  the  trajectory  data  correctly  in  the  ATAR  and  AAUX 
cells.  TARMAX  and  DESENT  may  then  operate  easily  on  these  arrays 
to  compute  the  targeting  matrix  or  gradient  directions. 

In  both  calls  TAR0PT(2)  and  TAR0PT(3),  the  trajectory  data  are 
printed  out  before  exiting  from  TAR0PT. 
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382-2 


TAR0PT-1O 
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TARPRL  Analysis 


The  position  components  of  a planet  are  related  to  its  orbital  elements 
a,  e,  i , Q , Id,  and  M through  the  following  set  of  equations: 


x = r cos  i?cos(ld+!d)  - sin  Q sin(ld+j/)  cos  i 

y = r sin^?cos  (Cw  + V ) + cos  Q sin(U/+v)  cos  i 

z ■=■  r sin(W+I/)  sin  i 

r =•  a(l  - eV 
1 + e cos  V 


vs 


M = E » e sin  E 


(1) 

(2) 

(3) 

(4) 

(5) 

(6) 


We  can  write  equations  (1),  (2),  (3),  and  (4)  symbolically  as 
xi  = f^a,  e>  i,S2  , v ) 
and  equations  (5)  and  (6)  as 


V ■=  V (e,  M)  . 


Then  the  partials  of  x with  respect  to  a,  e,  i,  Q,  Id,  and  M can  be 
evaluated  as  follows: 


6>x. 

- - - r= 

d*t 

da 

d a 

d 

j df± ) 

+ 

c?fi  d v 

de 

1 1 

V 

d v <5  e 

<?xt 

d fi 

Di 

di 

d x1 

dt  i 

~Fq 

bQ 

(7) 

(8) 

(9) 

(10) 
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_2£i 

do> 

du> 

dxi 

d fi 

dv 

dn 

dv 

<3m 

(ID 


(12) 


Only 


dv 


and 


dv 


require  further  consideration  before  equations  (7) 


d e 

through  (11)  can  be  used  to  obtain  expressions  for  the  18  desired  partial 
derivatives . 


We  obtain  E.  by  first  differentiating  equation  (5)  with  respect  to  E 
<3m 

and  equation  (6)  with  respect  to  M to  obtain 


dv 

dv 


and 


dE  = a 
d M r 


Then 

dv  m dv  , dE 
d M d M 


(13) 


We  obtain  by  first  differentiating  equation  (6)  with  respect  to  e 

d e 

to  obtain 


a M 

de 


VT 


Y 

- e sin  V 
+ e cos  V 


This  result  is  then 

combined  with 

equation  (13)  to  yield 

a v 

_ -lii- 

aM  fa 

^ 2 
| (1  - e ) sin  V 

de 

aM 

a e = [r 

1 1 + e cos  V 

(14) 
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The  evaluation  of  the  desired  partials  can  now  proceed.  The  results 
are  summarized  below. 

a.  Partials  with  respect  to  a. 


dJL.  = 2S 
da  a 

. 1 
da  a 


d z z 

da  a 


b.  Partials  with  respect  to  e. 


ax 

xq 

. -L 

dV 

ae 

r 

T 

r 

de 

dy  = 

. yq 

. -f 

a v 

ae 

r 

JL 

a e 

az 

zq 

y 

a v 

de 

r 

X 

a e 

S3 1-  r -dJL.  | - cos  £?sin(W  + v)  - sin Qcos  + v ) cos  il 
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c.  Partials  with  respect  to  i. 
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d.  Partials  with  respect  to  Q 
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e.  Par tials  with  respect  to  OJ 
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“ r ^ - cos  Q sin  (OJ+V)  - sin  jQcos  (w  + V ) cos  ij 
m r£-  sin£?sin(W  + V)  + cos  Qcos  (U  + V ) cos  ij 
= r cos  (tJ  + y ) sin  i 


f.  Partials  with  respect  to  M. 
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Vi  - 7 


Reference:  Battin,  R.  H. : Astronautical  Guidance,  McGraw-Hill  Book 

Company,  Inc.,  New  York,  1964. 
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THP0SM  Analysis 

THP0SM  locates  by  cubic  interpolation  the  minimum  of  a scalar 
function  f of  one  variable  on  the  closed  interval  from  0 to  A 
(positive),  assuming  f has  a unique  point  on  that  interval  where 
its  derivative  vanishes  and  that  this  extreme  value  is  indeed  a 
minimum.  The  algorithm  fits  a cubic  polynomial  through  function 
values  at  0,  aA , and  A as  well  as  through  the  function's  slope 
at  0.  Here  aA  should  be  on  the  open  interval  from  0 to  A and 
preferably  near  the  middle.  The  abscissa  of  the  minimum  is  then 
approximately  by  the  abscissa  of  the  corresponding  minimum  of  the 
cubic. 


The  coefficients  of  the  approximating  cubic  can  readily  be  deri- 
ved once  and  for  all  and  cast  into  a form  facilitating  speedy 
execution.  This  approach  proves  much  more  economical  of  machine 
time  than  solving  for  them  each  pass  with  a linear  system  routine 
as  is  frequently  done  in  polynomial  fitting. 

Denote  the  approximating  cubic  polynomial  by 

c(X)  = aQX3  + a^X2  + a2X  + ay  (1) 

Then  clearly 

a3  = f (0)  (2) 

and 

a2  = f'(0)  (3) 

One  also  has  that 

f (A)  = aQX3  + a^2  + f ' (0) A + f (0)  (4) 

and 

f(aA)  = a^c^A3  + a^a2A2  + f’(0)aA  + f(0).  (5) 


Solving  these  last  two  equations  for  a^  and  a^  yields 


a„  = 


0 A3a2 


Af ' (0)  a + f (0)  (1+a)  + 


(6) 
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and 


_ Aa(l+a)f'(0)  - f (0)  (1+a+a2) 


1 X2a2 

For  an  extreme  value s Xe„  one  knows  that  c'|xej  = 0,  that  is. 


• (7) 


3a_X  2 +2a,X  + a_  = 0 


0 e 


1 e 


(8) 


Hence 


-a,  i/a 


X 


3a„a 


0 2 


'1,2 


3a„ 


The  question  remains  as  to  which  of  these  two  extrema  is  a mini- 
mum. It  is  shown  in  elementary  calculus  that  an  extremum  is  a 
minimum  if,  and  only  if,  the  second  derivative  is  positive  there. 
Now 


c"(X)  = 6aQ  X + 2a±. 


Hence 


6a, 


~al  V“l2  ~ 3a0a2 
3a_ 


+ 2a. 


= ±2^  - 3aQa2 


Thus  the  cubic  has  its  minimum  at 


X . 
min 


3aoa2 


The  preceding  formula  for  the  minimum  will  obviously  be  inade- 
quate when  aQ  = 0 as  is  the  case  when  minimizing  a quadratic. 

However  it  can  be  shown  that 


lim  X 
a0->° 


min 
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and  hence  when  = 0 we  take 


X 


min 


THP0SM  provides  diagnostic  printouts  and  stops  execution  of  the 
calling  program  in  the  three  conceivable  cases  of  difficulty: 

(1)  the  cubic  degenerates  to  a straight  line,  (2)  the  cubic 
degenerates  to  a quadratic  with  no  minimum,  (3)  the  cubic  is 
nondegenerate  but  has  no  extrema,  or  (4)  the  minimum  of  the  cubic 
does  not  fall  between  0 and  A. 
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TPPR0P  Analysis 

The  subroutine  TPPR0P  has  the  sole  responsibility  for  propagating 
miniprobes.  It  is  called  on  to  do  so  in  two  basic  applications. 
The  first  is  in  calculating  the  miniprobe  targeting  constraint 
given  the  release  control  _u  as  repeatedly  required  in  the  miss- 
minimization  process  (see  analysis  of  TPRTRG) . The  second  is  in 
describing  the  minimum-miss  miniprobe  approach  trajectories  once 
the  optimal  release  controls  have  been  found.  This  includes  gen- 
erating impact  data  for  both  conic  and  virtual-mass  propagation 
as  well  as  time  histories  of  the  latter.  The  logic  of  TPPR0P  is 
considerably  complicated  by  the  requirement  that  it  be  able  to 
propagate  the  approach  trajectories  according  to  either  a high- 
speed conic  model  or  an  accurate  virtual-mass  n-body  integrator. 


First  consider  the  problem  of  calculating  jj>.  given  £.  For  this 

application  of  TPPR0P,  the  miss-minization  status  flag,  IFIN2, 

is  set  to  1.  In  either  propagation  mode  the  velocity,  v , of 

iR 

the  ith  miniprobe  just  after  release  must  be  computed  first  of 

all.  Let  v be  the  velocity  of  the  bus  at  release  and  <j> . be 
JdK  1 

the  release  roll  angle  of  the  ith  probe.  Let  U,  V and  H be  the 
probe  release  reference  vectors  defined  in  the  analysis  section 
of  TPRTRG.  By  <f>^  we  mean  the  angle  the  release  velocity  incre- 
ment of  the  ith  miniprobe  makes  with  the  U direction.  It  should 
not  be  confused  with  the  angle  the  ith  probe  arm  makes  with  the 
U direction,  which  is  tt/2  radians  smaller.  Next  define  v^  to  be 

the  common  tangential  velocity  of  the  miniprobes  at  release. 

Then  the  velocity  of  the  ith  miniprobe  at  release  is 

+ sin  <j>.vl  + vfiR  i = 1,2,3.  (1) 


-iR 


cos 


i.U 

l— 


Let  a and  6 denote  the  right  ascension  and  declination,  re- 
ri  ri 

spectively,  of  the  spin  axis  at  release.  Then  by  expressing  U 
and  V in  terms  of  these  angles,  equation  (1)  reduces  to  the 
following  in  the  planetocentric  ecliptic  system: 


-iR 


v„ 


/sin  « \ 


cos 


-cos  a„|+  sin 


V 0 


H 


/cos  a 
sin  a 

H 

L-cos  <S 


H 


sin  6 
sin  6 


+ 


-BR 


i = 1,2,3  (2) 
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Simplifying  equation  (2)  yields  the  computational  form  of  the 
ith  miniprobe  velocity  increment: 


-iR  VT 


/sin  aTI  cos  <b . + cos  a„  sin  6„  sin  d> . 

' H Ti  H H Ti 

-cos  cos  4> + sin  au  sin  6U  sin  <f>^  | + v. 


i H ~H 

- cos  6tt  sin  d> 

H Y] 


■BR 


(3) 


i = 1,2,3. 


The  sines  and  cosines  of  a and  6 necessary  in  equation  (3)  are 

' n n 

all  calculated  in  a single  call  to  the  subroutine  SA0CS  given 
the  spin-axis  orientation  flag,  ISA0. 


At  this  point  the  algorithms  for  calculating  the  constraint  ip 

diverge  for  the  two  miniprobe  propagation  models.  In  the  conic 

propagation  mode,  signaled  by  the  flag  IPR0P  set  to  1,  v in 

— BR 


equation  (3)  represents  the  velocity  of  the  equivalent  conic 
release  state  of  the  bus  (see  TPRTRG  analysis).  Hence,  to 
determine  the  actual  B-plane  pierce  point  coordinates  /B 


and 


B. 

x 


as  well  as  the  parameters  S^,  T^,  R and  a for  the  ith 


miniprobe,  TPPR0P  simply  applies  the  subroutine  STIMP  to  the  state 


/ T 1 T\T  , 
yrBR  ! viR  ) ”here  r- 


denotes  the  equivalent  conic  position 


BR  [ iR  / -BR 

of  the  bus  (and  hence  also  of  the  ith  probe)  at  release.  Deter- 
mining the  desired  B-plane  pierce  point  coordinates,  ^B^  • T^j 


and  • R^j  , of  the  ith  probe  is  complicated  by  the  fact  that 

the  miniprobes  must  be  correctly  paired  with  the  impact  sites. 

The  first  miniprobe  is  targeted  to  the  miniprobe  site  whose 
pierce  point  at  the  time  of  the  calculation  of  the  initial  con- 
trol estimate  in  TPRTRG  was  nearest  the  bus  pierce  point.  Hence 
|B^  • T^j  and  |B^  • R^  are  readily  calculated  by  the  appropri- 
ate call  to  DIMPCP,  with  the  right  ascension  and  declination  of 
the  target  site  used  in  the  initial  control  estimate  and  the  JS 
and  a of  the  current  miniprobe  1 trajectory.  Next  TPRTRG  com- 
putes two  sets  of  desired  B-plane  coordinate  pairs,  ^ • T ^ j 

and  / B^  * applying  DIMPCP  successively  to  each  of  the 


remaining  pairs  of  miniprobe  target  sites  using  in  both  cases  the 
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S and  a of  the  current  miniprobe  2 trajectory.  With  these  two 
sets  of  desired  pierce  point  coordinate  pairs  relative  to  mini- 
probe 2 now  available  for  comparison,  TPPR0P  selects  the  set 
whose  Euclidean  distance  from  the  pierce  point  of  miniprobe  2 
is  the  smaller.  Finally,  |B^  * T^j  and  ^B^  • R^j  are  calcu- 
lated by  calling  DIMPCP  with  right  ascension  and  declination  of 
the  remaining  miniprobe  target  site  and  the  S_  and  a of  the  cur- 
rent miniprobe  3 trajectory.  At  this  point  an  approximately  in- 
herent in  the  application  of  the  subroutine  DIMPCP  to  the  mini- 
probes must  be  noted.  The  time-varying  transformation  from 
planetocent ri c-eclip tic  coordinates  to  the  probe-impact  frame 
required  by  DIMPCP  is  held  fixed  at  the  time  of  the  bus  impact. 
This  approximation  is  more  than  adequate  for  engineering  pur- 
poses. All  of  the  required  B-plane  data  for  the  three  mini- 
probes  having  been  assembled,  TPPR0P  can  now  calculate  the  ith 
and  (i+3) rd  components  of  the  constraint  vector: 


i = 1,2.3.  (4) 


here  the  Ch's  are  weighting  factors  indicating  the  relative  im- 
portance of  achieving  nearby  impacts  at  the  respective  miniprobe 
targeL  sites.  Finally,  the  release  roll  angle  for  the  next  mini- 
probe can  be  found  from  that  of  the  current  one  by  applying  the 
addition  formulas  for  the  sine  and  cosine: 

Sin  ^i+i  = sin  1,1  i + cos  <!,i)  /2  (5) 

C°K  <(’i+l  = (C°S  ~ ^ Sin  ^ l)  /2‘ 

The  iterative  process  is  started  by  noting  that  i|i  is  simply  <f> , 
the  first  component  of  the  control  vector. 

For  virtual-mass  propagation  indicated  by  IPR0P=2,  the  general 
structure  of  the  jj>  computation  remains  the  same  but  the  interpre- 
tation of  the  conti tuent  state  vectors  changes.  The  v in  equa- 

— BR 

tion  (3)  is  taken  as  the  velocity  ol  the  actual  virtual-mass  re- 
lease state.  Then  VMP  is  called  to  integrate  the  virtual 

T 

of  the  Lth  minfprobe  just  after 
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release  to  a pseudosphere  whose  radius  is  one-tenth  that  of  the 
actual  Laplacian  sphere  of  influence.  From  this  distance  inward, 
conic  extrapolation  of  the  current  state  suffices  for  engineering 
calculations.  For  the  actual  B-plane  pierce-point  coordinates, 

( B , • T.\  and  /B.  • R. j , as  well  as  the  quantities  S,  T,  R and 
1 'A  ' 1 1 A 

for  the  ith  miniprobe,  TPPR0P  again  simply  makes  a single  call 
to  STIMP  but  this  time  with  the  virtual-mass  state  at  the  pseudo- 
sphere rather  than  the  equavalent  conic  state  at  release.  The 
remainder  of  the  virtual-vass  constraint  vector  computation  In- 
cluding the  computation  of  the  desired  miniprobe  B-plane  pierce 
points  via  the  subroutine  DIMPCP  proceeds  exactly  as  for  the 
conic  model. 


Next  consider  the  provisions  in  TPRTRG  for  describing  the  minimum- 
miss  miniprobe  approach  trajectories.  Throughout  this  application, 
the  miss-minimization  status  flag,  IFIN2,  must  be  set  to  2.  First 
in  this  area  TPPR0P  must  supply  the  impact  data  for  the  miniprobes 
using  the  conic  propagation  model  on  the  conic  minimum-miss  re- 
lease controls.  This  is  done  by  setting  the  progation  mode  flag, 
IPR0P  to  1.  Then  with  IFIN2=2 , TPPR0P  uses  the  state 
T 


T ' 1 

r v 

— BR  j -iR 


constructed  from  the  bus  equivalent  conic  release 


state,  the  conic  minimum-miss  release  controls,  and  equation  (3) 
to  generate  an  osculating  conic  by  a call  to  CAREL . The  sine  and 
cosine  of  the  true  anomaly  and  the  time  at  impact  are  determined 
by  a call  to  SPHIMP.  Then  the  Cartesian  planetocentric  ecliptic 
state  is  evaluated  by  a call  to  CONCAR.  From  these  data  the 
right  ascension  and  declination  of  the  impact  site,  as  well  as 
the  time,  speed,  and  flightpath  angle  at  impact  for  the  ith 
miniprobe  can  be  calculated  from  the  formulas  used  in  computing 
the  same  quantities  for  the  bus.  These  are  described  in  the 
TPRTRG  analysis.  The  angle  of  attack,  a , for  the  ith  miniprobe 

however  requires  separate  treatment.  It  is  assumed  that  the 
longitudinal  body  axies  of  each  miniprobe  remains  parallel  until 
impact  to  the  spacecraft  spin  axis  at  realse.  Thus  if  repre- 

sents the  velocity  of  the  ith  miniprobe  at  impact, 


cos 


-1 


(it  • Xu/lPull) 


i = 1,2.3. 


(7) 
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Equation  (5)  can  be  expressed  in  terms  of  the  angles  m and  iS 
as  follows: 


The  second  trajectory-descriptive  function  of  TPPR0P  is  calculat- 
ing the  virtual-mass  miniprobe  approach-trajectory  time  histories 
and  impact  data.  This  is  always  done  for  the  conic  minimum-miss 
release  controls  and  also  for  the  virtual-mass  controls  whenever 
these  are  calculated.  The  propagation  flag,  IPR0P  is  simply 
set  to  2 and  the  heading  "Miniprobe  I Minimum-Miss  Approach 
Trajectory"  is  printed.  Then  with  IFIN2=2,  the  state 

/ T | t\T 

I r_  I Z-jd  I produced  from  the  bus  actual  virtual-mass  release 

state,  the  appropriate  minimum-miss  release  controls  (conic  or 
virtual-mass  as  the  case  may  be),  and  equation  (3)  is  integrated 
all  the  way  to  impact  by  VMP  with  its  print  flag  on  and  its  print 
increments  set  at  5 days  and  100  integration  steps.  in  this 
simple  manner  the  miniprobe  approach  time  histories  are  provided. 
Finally,  the  impact  data  for  the  virtual-mass  ith  miniprobe  tra- 
jectory are  calculated  by  the  same  steps  as  for  the  conic  case 
except  that  the  actual  virtual-mass  miniprobe  impact  state  rather 
than  the  equivalent  conic  miniprobe  release  state  is  used  in  gen- 
erating the  osculating  conic  via  the  call  to  CAREL . 
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TPPR0P  Flow  Chart 


TPPR0P-7 
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TPPR0P  Flow  Chart  (concl) 


I 


Generate  mini  probe 
impact  data  for 
output  from  TPPTRG 


388-13 


TPRTRG-1 


TPRTRG  Analysis 

TPRTRG  is  the  executive  routine  directing  multiprobe  targeting. 

To  do  so  it  must  accomplish  four  basic  tasks:  (1)  process  mini- 

probe targeting  input  data,  (2)  generate  initial  estimates  for 
the  release  controls,  (3)  apply  the  least-squares  routine,  CAUSES, 
to  minimize  the  miniprobe  miss  index,  and  (4)  use  the  miniprobe 
propagating  routine,  TPPROP , to  generate  minimum-miss  approach 
trajectories  and  impact  data.  Each  of  these  objectives,  as  well 
as  the  routine's  printout,  is  discussed  in  the  following  para- 
graphs . 

The  processing  of  the  miniprobe  targeting  input  involves  three 
major  aspects.  First  an  equivalence  must  be  set  up  between  the 
multipurpose  targeting  variables  of  N0MINAL  and  the  mnemonic 
symbolism  of  TPRTRG.  Second,  a conic  miniprobe  release  state 
must  be  determined  that  is  equivalent  to  the  virtual-mass  release 
state  for  use  in  the  high-speed  conic  miniprobe  propagation  model. 
By  equivalent  we  mean  that  although  one  state  falls  on  a conic 
and  the  other  on  a virtual-mass  trajectory,  both  states  occur  at 
the  same  absolute  time  and  the  two  trajectories  are  tangent  at 
impact.  To  generate  the  equivalent  conic  release  state,  the  sub- 
routine VMP  is  called  to  propagate  the  bus  state  from  release  to 
impact.  Before  doing  this,  however,  the  VMP  trajectory  condition 
flags  are  stored  for  subsequent  restoration  after  exiting  TPRTRG. 
The  virtual-mass  impact  state  is  then  fit  with  an  osculating  conic 
by  a call  to  CAREL.  The  osculating  conic  is  then  propagated  back 
to  the  actual  release  time  via  calls  to  the  subroutines  HPOST  and 
CONCAR.  Using  this  conic  release  state,  a set  of  minimum-miss 
controls  for  the  conic  model  can  now  readily  be  determined.  The 
third  phase  of  processing  miniprobe  input  data,  namely  setting  up 
the  several  targeting  options,  is  next  begun.  First  the  coordinate 
transformation  matrix,  C,  from  the  planetocentric  inertial  ecliptic 
coordinates  to  the  Cartesian  frame  in  which  the  miniprobe  impact 
sites  are  specified  is  generated  by  a call  to  either  the  sub- 
routine SUBSOL  or  PECEQ,  depending  on  the  state  of  the  coordinate- 
system  flag  IPCSK.  The  spin  axis  orientation  mode  desired  is 
stored  in  the  flag  ISA0.  It  is  used  by  TPRTRG  in  devising  an 
initial  control  estimate  and  by  TPPR0P  in  all  miniprobe  propaga- 
tions. Finally,  the  desired  miniprobe  propagation  mode  is  stored 
in  the  flag  IPR0PI.  This  variable  is  used  solely  by  TPRTRG  in 
deciding  on  which  propagation  mode  to  request  from  TPPR0P  via  the 
common  flag  IPR0P . 
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TPRTRG  next  deals  with  the  problem  of  generating  an  initial  estimate 
of  the  control  vector.  First  consider  the  problem  of  estimating 
the  conic-model  minimum-miss  controls.  Initial  estimates  for  two 
of  the  controls  (the  spin  axis  orientation  angles)  depend  of 
course  on  the  spin  axis  orientation  mode.  In  three  of  the  four 
possible  modes,  the  inertial-ecliptic  declination  and  right  as- 
cension of  the  spin  axis  are  fixed  rather  than  free  controls. 

Hence  no  initial  estimates  for  them  need  be  provided.  In  the 
remaining  mode,  however,  both  of  these  controls  are  free,  and 
the  initial  estimates  provided  for  them  are  simply  those  that 
bring  the  spin  axis  into  coincidence  with  the  spacecraft  velocity 
vector  at  release.  This  orientation  was  chosen  for  the  initial 
estimate  since  it  produces  the  widest  distribution  of  miniprobe 
entry  sites  for  a given  combination  of  the  remaining  two  release 
controls.  Regardless  of  the  orientation  mode,  the  spin  axis 
pointing  direction  is  specified  throughout  miniprobe  targeting 
by  the  sines  and  cosines  of  its  ecliptic  declination  and  right 
ascension.  These  trigonometric  functions  are  always  calculated  by 
the  subroutine  SA0CS  from  the  appropriate  components  of  the  con- 
trol vector  and  the  spin  axis  orientation  flag.  Since  the  spin 
axis  pointing  direction  is  necessary  in  initially  estimating  the 
other  two  controls,  TPRTRG  must  call  SA0CS  to  obtain  the  above 
trigonometric  characterization. 

Initial  estimates  for  the  roll  release  angle,  (j>,  of  the  first 
probe  and  the  tangential  velocity  at  release,  v^,  can  then  be 

generated  by  merely  targeting  the  first  miniprobe  to  the  miniprobe 
target  site  nearest  the  impact  point  for  the  bus  on  the  trajectory 
existing  at  release.  First,  the  B-plane  pierce  point  of  the  bus 
is  calculated  by  calling  the  subroutine  STIMP  with  the  bus  impact 
state.  Then  the  desired  B-plane  pierce  point  corresponding  to 
each  of  the  three  miniprobe  target  sites  is  computed  through  a 
call  to  DIMPCP.  It  must  be  noted  that  this  calculation  is  only 
approximate  since  it  assumes  all  of  the  miniprobes  have  the  same 
S_  and  impact  time  as  the  bus.  Nonetheless,  the  accuracy  is  more 
than  sufficient  for  engineering  purposes.  Next  the  pierce  points 
of  the  desired  miniprobe  impact  sites  are  compared  to  find  the 
one  nearest  that  of  the  bus.  The  release  velocity  increment  per- 
pendicular to  the  bus  spin  axis  that  would  target  the  first  mini- 
probe is  then  approximated  by  a single  Newton-Raphson  step.  Let 
B^'T,  B^R,  B^*T,  and  B^*R  denote  the  B-plane  pierce  point 

components  corresponding  to  the  bus  and  the  desired  miniprobe 
impact  sites,  respectively.  Define  a constraint  vector  as 
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Bi'T  - BB*T\ 

vr-  vR; 


(i) 


Let  H denote  a unit  vector  in  the  direction  of  the  spin  axis  of 
the  spacecraft.  Using  H,  define  IJ  and  V as 

U = Hxz/||HxZ  II  (2) 

— — — ec  / — — ec 

V = H x u (3) 

where  Z is  the  inertial  ecliptic  pole  vector.  Then  a conven- 
— ec 

ient  probe-release  Cartesian  frame  is  defined  by  the  triple  U-V-H. 
Let  Av^  and  Au^  denote  the  components  of  the  release  velocity  in- 
crement in  the  U and  V directions,  respectively. 

Then  the  control  vector  is  given  by 


X = 


(A) 


Let  J denote  the  Jacobian  matrix  of  j;  with  respect  to  i.e., 


i = 1,2 
j = 1,2. 


(5) 


One  Newton-Raphson  step  then  approximates  the  targeting  control 
vector  as 


X = J~ 1 <p. 


(6) 


TPRTRG  computes  the  Jacobian  matrix  by  divided  differencing. 

Let  v represent  the  equivalent  conic  planetocentric  velocity 
BK 


of  the  bus  at  release.  Let  5 v.,. 

U — BK 


and  denote  the  perturba- 

V — BK 


tions  in  vTin  caused  by  a velocity  increment  of  magnitude  6v  in 
BK 

the  _U  and  V directions,  respectively.  Then  clearly 


Vbr  ■ Sv£ 

(7) 

Vbr  ■ Sv^' 

(8) 
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Let  a and  6 be  the  right  ascension  and  declination  of  the  spin 
H H 

axis,  respectively.  By  expressing  the  definitions  of  U and  V in 
terms  of  these  angles,  equations  (7)  and  (8)  can  be  expressed  in 
the  planetocentic  ecliptic  frame  as 


Vbr 


6v  (sin  u,  -cos  «, 


(9) 


/ 


Vbr  = 6v  (cos 


sin  6,  sin  a sin  6,  -cos  <S) 


(10) 


Let  r be  the  equivalent  conic  planetocentric  position  of  the 
— BR 


spacecraft  at  release.  Then  by  applying  the  subroutine  STIMP 
consecutively  to  the  states  (rBR,  v£R  + ^v^)1  and  (rBR,  XBR 
+ 1 , the  perturbed  state  vectors  6^  and  6 ^ can  be  gener- 

ated. TPRTRG  then  approximates  J as  ^6^  j 6 jo v . Having 
approximated  Av^  and  A v^,  the  roll  release  angle  of  miniprobe  1 

and  the  tangential  velocity  at  release  are  readily  calculated 
from  the  formulae 


VT 


Avu2  + Avv2 


4>  = tan"1  ^Avy  j AVyj 


(ID 

(12) 


It  must  be  noted  that  <p  represents  the  angle  the  velocity  incre- 
ment of  the  first  miniprobe  makes  with  the  U axis.  It  should 
not  be  confused  with  the  angle  between  the  first  probe  arm  and 
the  U direction,  which  is  it/ 2 radians  less  than  <p. 

Consider  next  the  initial  control  estimate  for  virtual-mass  mini- 
mum-miss controls.  TPRTRG  simply  uses  the  minimum-miss  conic 
control  for  this  estimate.  Hence,  irrespective  of  the  desired 
miniprobe  propagation  mode  indicated  by  IPR0PI,  the  conic  con- 
trols are  first  found.  Then  if  only  the  conic  controls  are  de- 
sired, a return  is  made  to  the  calling  program;  otherwise  the 
least-squares  algorithm  is  repeated  with  virtual-mass  rather 
than  conic  miniprobe  propagation. 

The  third  basic  task  of  TPRTRG,  namely  using  the  subroutine  GAUSLS 
to  calculate  the  minimum-miss  index  controls,  requires  some  ex- 
planation. First  the  four  miniprobe  release  controls  must  be 
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identified.  They  are  simply  , v , <5^,  and  (see  Fig.  1) 
if  u denotes  the  control  vector,  then 


M 


Thus 


(13) 


By  measuring  the  angles  <p , a , and  6 in  radians  and  the  velocity 

n ri 

v^  in  decameters/s  all  of  the  components  of  _u  fall  in  the  range 

from  0.1  to  10  as  required  by  the  subroutine  GAUSLS  when  Jacobian 
matrices  are  generated  by  a uniform  control  perturbation  of  10~5 . 


Let  /b.  • T.)  and  (B,  • R.^  denote  the  actual  B-plane  pi'erce 

point  coordinates  of  the  ith  miniprobe  when  the  release  control 
u is  applied.  Let  |B^  • T^j  and  |B^  • represent  the  de- 

sired B-plane  pierce  point  coordinates  of  the  ith  miniprobe 
based  on  the  actual  and  the  energy  of  that  miniprobe.  The  six 
components  of  the  constraint  vector  are  then  given  as 


ip.  = C. 

ri  l 


^i+3  Ci 


(14) 

i = 1,2,3. 

(15) 


Here  the  C^'s  are  weighting  factors  input  by  the  user  to  indicate 

the  relative  importance  of  achieving  nearby  impacts  at  the  various 
miniprobe  target  sites.  The  subroutine  TPPR0P  is  always  used  to 
calculate  given  u for  whichever  miniprobe  propagation  mode  is 
specified  by  the  flag  IRP0P.  Thus  GAUSLS  can  be  called  to  carry 
out  the  entire  least-squares  process  of  minimizing  the  miss-index 
T 

y = ii  for  either  propagation  mode  once  the  initial  control 
estimate  uo  and  the  corresponding  constraint  (uo)  have  been 
calculated.  If  the  least-squares  routine  should  fail  to  converge, 
the  universal  N0MNAL  trouble  flag,  KWITT,  is  set  to  1 to  cause 
execution  to  terminate  on  return  to  the  main  program,  and  a re- 
turn is  made  to  the  calling  program,  GIDANS. 
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The  final  responsibility  of  TPRTRG  is  to  calculate  the  n-body 
miniprobe  approach  trajectory  time  histories  and  impact  data  for 
the  bus  and  the  miniprobes  using  the  minimum-miss  release  con- 
trols corresponding  to  both  the  conic  and  virtual-mass  propaga- 
tion modes.  The  impact  data  for  the  bus  are  calculated  in  TPRTRG 
itself.  Let  rDT  and  p.T  denote  the  impact  position  vectors  in 

the  planetocentric  ecliptic  and  probe-impact  coordinate  frames. 
The  p is  calculated  from  r , which  is  available  from  the 

— Jd  i — D 1 

virtual-mass  propagation,  as 

— BI  = C-BI‘  (16) 

The  right  ascension,  a„ , and  declination,  6 , of  the  bus  impact 

D D 

site  relative  to  the  probe-impact  frame  are  then  readily  calcu- 
lated as 


(17) 

(18) 


The  flightpath  angle,  Ygj 


tan 


1 /e  rT  sin  0 


;/  p) 


(19) 


where  r^.  is  the  radius  of  the  impact  sphere,  e is  the  eccentricity, 

p is  the  semilatus  rectum  and  0-j.  is  the  true  anomaly  at  impact. 

All  of  these  conic  dements  refer  to  osculating  hyperbola  at  im- 
pact. The  magnitude  of  the  bus  impact  velocity  is  calculated  as 

VBI  ‘ fWP I - 1/a)  <20> 


where  a is  the  semimajor  axis  of  the  osculating  conic,  and  u is 
the  gravitational  constant  of  the  planet. 


For  the  miniprobes,  both  the  impact  data  and  the  virtual-mass 
approach  trajectory  time  histories  are  generated  by  a call  to 
TPPR0P  with  the  least-squares  status  flag  IFIN2  set  to  indicate 
that  the  miss-minimizing  procedure  is  complete.  When  the  least- 
squares  algorithm  is  performed  using  conic  miniprobe  propagation, 
impact  data  are  computed  for  both  the  conic  and  virtual-mass  models. 
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The  printout  from  TPRTRG  is  designed  to  meet  two  objectives:  (1) 

to  completely  describe  the  minimum-miss  miniprobe  approach  tra- 
jectories, and  (2)  to  reveal  any  errors  in  the  minimum-miss  re- 
lease controls  caused  by  improper  use  of  the  program.  To  iden- 
tify the  type  of  nolinear  guidance  event,  the  heading  "Miniprobe 
Targeting  Event"  is  printed  first  of  all.  Next  pertient  data  at 
release  are  printed.  These  consist  of  the  planetocentric  bus 
impact  state  and  the  equivalent  conic  release  state  as  previously 
described.  Then  the  printout  from  the  miss-minimizing  algorithm 
GAUSLS  is  provided  in  its  entirety.  After  the  minimum-miss  re- 
lease controls  are  found,  they  are  printed  out  with  a phrase 
indicating  whether  they  correspond  to  the  conic  or  virtual-mass 
model.  If  conic  miniprobe  propagation  was  used  for  the  miss 
minimization,  the  conic-model  probe  impact  data  are  printed. 

These  include  right  ascension  and  declination  of  the  impact 
point,  together  with  time,  velocity,  and  flightpath  angle  at 
impact  for  each  of  the  miniprobes  as  well  as  the  bus  (numbered 
as  probe  number  0 in  the  printout) . The  bus  data  provided  here 
are  actually  based  on  the  initial  virtual-mass  propagation  from 
the  release  state.  The  miniprobe  data  also  contain  the  angles  of 
attach,  assuming  the  minprobe  longitudinal  body  axes  reamin  paral- 
lel to  the  spacecraft  spin  axis  at  release.  Next  the  time  his- 
tories of  the  miniprobe  minimum-miss  approach  trajectories  are 
printed  in  succession  from  the  subroutine  VMP  with  print  inter- 
vals of  5 days  and  100  integration  steps.  Finally,  the  virtual- 
mass  model  probe  impact  information  is  printed.  It  is  identical 
in  content  to  the  conic  impact  data  except  that  the  information 
is  now  based  on  virtual-mass  propagation  from  the  release  state. 

TPRTRG  Flow  Chart 
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TPRTRG  Flow  Chart  (cont) 
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TPRTRG  Flow  Chart  (cont) 
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TPRTRG  Flow  Chart  (cont) 


j Initialize  constraint 
vector 

| (Call  TPPR0P) 


2 

Use  least-squares  procedure 
to  obtain  minimum-miss 
conic-model  release  controls 
(Call  GAUSLS) 
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Print  virtual -mass  time 
histories  of  miniprobe 
approach  trajectories  for 
minimum-miss  conic  release, 
controls  / 

(from  VMP)  / 


Print  virtual -mass  model 
mini  probe  and  bus  impact 
data  for  minimum-miss  / 
conic  release  controls/ 
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TPRTRG  Flow  Chart  (cont) 
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TPRTRG  Flow  Chart  (concl) 


'Trint  virtual  mass  time  histories 
of  mini  probe  approach  trajectories, 
for  minimum-miss  virtual -mass 
release  controls 
(From  VMP) 


'Print  virtual-mass  model  miniprobe 
and  bus  impact  data  for  minimum- 
miss  virtual -mass  release  controls; 


Restore  previous 
VMP  trajectory 
condition  flags 


( RETURN 
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X , Y , Z 
-ec  -ec  -ec 


right  ascension  of  spin  axis 
declination  of  spin  axis 
roll  release  angle  of  first 
mini  probe 

tangential  release  velocity 
of  ith  mini  probe 
spacecraft  spin-axis  unit 
vector 

HxZ  / I HxZ  { 

ec'  1 ec1 

HxU 

inertial  ecliptic  coordinate- 
axis  unit  vectors 


Figure  1 Mi  nip 
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TRAKM  Analysis 

The  linearized  observation  equation  can  be  written  as 

y = Hx  + Mx  + Gu  + Lv  + Nw 
s 

where  y is  the  observable,  x is  the  spacecraft  state,  and  x , u, 

v,  and  w are  solve-for,  dynamic  consider,  measurement  consider,  and 
ignore  parameter  vectors,  respectively.  The  function  of  subroutine 
TRAKM  is  to  compute  the  observation  matrix  partitions  H,  M,  G,  L, 
and  N,  which  indicate  the  sensitivity  of  the  observable  y to  changes 
in  x,  x^,  u,  v,  and  w,  respectively,  in  the  error  analysis/generalized 

covariance  analysis  program.  The  matrix  N is  computed  only  for  a 
generalized  covariance  analysis. 

Except  for  computation  of  the  ignore  parameter  observation  matrix 
partition  N,  TRAKM  is  equivalent  to  subroutine  TRAKS,  which  is  used 
in  the  simulation  program.  See  subroutine  TRAKS  for  further  an- 
alytical details  and  a flow  chart. 
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TRAKS  Analysis 


Subroutine  TRAKS  performs  two  functions  in  the  simulation  mode.  The  first 
function,  which  corresponds  to  I0BS  =0,  is  to  compute  all  observation 
matrix  partitions  for  the  measurement  type  indicated  by  ITRK.  The  second 
function,  which  corresponds  to  I0BS  ^ 0,  is  to  compute  the  measurement 
itself.  If  I0BS  = 1,  TRAKS  computes  the  measurement  corresponding  to  the 
most  recent  nominal  spacecraft  state.  If  I0BS  ■=  2,  TRAKS  computes  the 
measurement  corresponding  to  the  actual  spacecraft  state,  and,  if  the 
measurement  is  a range  or  range-rate  measurement,  to  the  actual  tracking 
station  locations.  The  number  of  rows,  NR,  in  the  measurement  and  the 
observation  matrix  partitions  is  also  computed. 

A general  measurement  has  form 

t = r (r,  r,  t ) 

where  X is  the  spacecraft  position/velocity  state  at  time  t and  p is 
a vector  of  parameters.  This  equation  can  be  linearized  about  nominal  X 
and  p*  to  obtain 

(if)  " * (•»)*  '■ 

where  ( )*  indicates  matrices  are  evaluated  at  the  nominal  condition. 

This  perturbation  equation  can  be  rewritten  as 


<JY  = H <5  X + M <5xg  + G <5  u + L <5  v^ 


where 


is  distributed  among  the  M,  G,  and  L 


partitions  to  correspond  to  the  partition  of  the  parameter  vector  dp  into 
solve- for  parameters  dx^,  dynamic  consider  parameters  §u  , and  measurement 

consider  parameters  6~v. 


In  the  remainder  of  this  section  the  measurement  equation  and  all  partial 
derivatives  required  to  construct  the  H,  M,  G,  and  L observation  matrix 
partitions  will  be  summarized  for  each  measurement  type. 


A.  Range  measurement  P . 


A range  measurement  has  form 
0 ( X,  R,  9,  0,  t) 

where  R,  9,  and  0 are  the  radius,  latitude,  and  longitude  of  the  relevant 
tracking  station. 
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More  explicitly,  ^ 

P-  [(X-XE-  xs)2+(y-ve-  ys)2  + (z.ze-  z/] 

where  X,  Y,  Z = inertial  position  components  of  spacecraft 

X , Y , Z = inertial  position  components  of  Earth 
E*  E E 

X , Y . Z = station  position  components  relative  to  Earth. 
S S S * 


X , Y . and  Z are  related  to  R,  9,  and  0 as  follows: 
S S S 


X = R cos  9 cos  G 
S 

Y = R cos  9 cos  € sin  G + R sin  9 sin  f 


z 

s 

-R  cos  9 

sin  € sin  G + R sin  1 

9 cos  € 

where  € is 

the  obliquity 

of 

the  Earth,  and 

G = 

0 

+ GHA 

where  GHA  is 

the  Greenwich  hour  angle  at 

time 

t . 

Partials  of 

p with 

respect 

to  spacecraft 

state  are 

given  by 

dP 
d X 

p <x- 

XE 

xs> 

_0P 

0X 

= 0 

dP  = 
a y 

Pi(*- 

Y - 
E 

y 

dp 
0 Y 

= 0 

ap 

0 Z 

p <z  - 

ZE  " 

zs> 

dp 
0 Z 

= 0 

Partials  of 

P with 

respect 

to  R,  9,  and 

0 

are  given  by 

0 p m 

. 

axs 

i 

0 P dYs 

t . 

dp 

0Zg 

a r 

dxs 

dR 

T 

0 Y 0 R 

“T 

dh  ' 

0 R 

dp 

dP 

dxs 

dp  aYs 

0 P 

*zs 

dQ 

ax 

s 

dQ 

0Y  09 

S 

+ 

0 Z 

s 

dp 

dp 

axs 

j. 

dp  d Ys 

ap 

15  zs 

00 

6xs  ' 

00 

nr 

d y a 0 

S v 

+ 

azs  * 

d0 
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where 

d p dp_  dp  _ _dj>  dp  _ d_p 

dx  ax  ay  by  dz  az 

b b b 

and  the  negatives  of  the  partials  of  X Y and  Z with  respect  to 

b b b 

R,  9,  and  0 are  summarized  in  the  subroutine  STAPRL  analysis. 

B.  Range-rate  measurement  p , 

A range- rate  measurement  has  form 
P = P ( X,  R,  9,  0,  t) 

where  all  arguments  have  been  defined  previously.  More  explicitly, 

p = ^xPx  + Py  Py  + Pz  P z 

P 


where 

n 

a* 

x - x - 

E 

XS  Px 

= x - x - x„ 

E S 

py  = 

Y - ye  " 

Y P 

S y 

■ 

Pz  = 

Z ' ZE  ' 

Z P 

S z 

- " - ZE  - £s 

V V and  zs 

are  related  to  R,  9,  and 

0 as  follows: 

X 

s 

- U)  R cos 

9 sin  G 

Ys  = 

U)  R cos  € 

1 cos  £ cos  G 

z 

s 

-O  R cos 

9 sin  € cos  G 

where  (j 

is  the  : 

rotational 

rate  of  the  Earth. 

Partials 

o 

of  p with  respect 

: to  spacecraft 

state  are  given  by 

dP 

- Px 

Px  P 

dP 

Px 

dx 

P 

P2 

dx 

P 

o 

a 

• 

* 

d_P 

= Jh 

dP 

= ei 

Oy 

P 

P2 

d y 

p 

dp 

o 

- Jh. 

Pz  P 

§1 

d z 

P 

P2 

d z 

p 
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The  partial  of  p with  respect  to  R is  given  by 


dp_ 
d r 


dP  $x, 


dx  d r 

o 


s + dP  aYs 


+ 


dP 


5ys  Or 


dzs  dR 


dP 


dK 


+ 


a*s  aR 


d P QYs  + dP_ 

a*s  ' aR 


azs  aR 


where 


and 


dP 

dP 

d\  " 

dx 

6p  . 

a* 

, etc . 


, etc . 


The  negatives  of  the  partials  of  Xg , Y , Zg,  Xg , Yg,  and  Zg  with  respect 

to  R,  0,  and  0 are  summarized  in  the  subroutine  STAPRL  analysis.  Partials 
of  p with  respect  to  9 and  0 are  treated  similarly. 

C.  Star-planet  angle  measurement  Of  . 

A star-planet  angle  measurement  has  form  Of 

Of  = Of  (X,  a,  e,  i,  Q , (J  , M) 

where  a,  e,  i , Q , co  , and  M are  the  standard  set  of  target  planet 
orbital  elements. 

If  we  differ  P = <PX,  Py,P  2 ) to  be  the  position  of  the  target  planet 

relative  to  the  spacecraft  and  (u,  v,  w)  to  be  the  direction  cosines  of  the 
relevant  star,  then 


Of  = 


cos 


-1 


(u p + vP  + w P ) 
P x y z 


where 


P=X-X,  p = Y - Y,  P=Z 


and  (Xpj  Yp,  Z ) represent  the  position  coordinates  of  the  target  planet. 
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Partials  of  a with  respect  to  spacecraft  state  are  given  by 


d a _ 1 

dx 


sin  a 


u 

P 


cos  cs 

P2 


da 


sin  a 


v 

P 


p cos  a 
p 2 


>a 
> Z 


sin  a 


w 

P 


COS  c< 


where 


sin  ot  = + 1 - cos 


£ 1 - cos^  d 


d a 
d x 


o 


da 

dir 


da 

dz 


o 


The  partial  of  of  with  respect  to  target  planet  semi-major  axis  is  given 
by 


da  _ da  ^Xp  da  d Yp  + d«  ® zp 

da  dx  da  dy  da  dz  da 

p p p 


where 


da 

dx 


da  da 
dx  dy 

p 


do?  do*  _ do* 

d y ’ dz  d z 

p 


and  partials  of  X , Y , and  Z with  respect  to  semi-maior  axis  are 
^ P P P J 

summarized  in  the  subroutine  TARPRL  analysis.  Partials  of  Of  with  respect 
to  Xp,  Yp,  and  Zp  do  not  appear  in  the  above  expression  since  they  are 

all  zero.  Partials  of  02  with  respect  to  the  remaining  target  planet 
orbital  elements  are  treated  similarly. 

D.  Apparent  planet  diameter  measurement  P . 

An  apparent  planet  diameter  measurement  has  form 

P = £(  X,  a,  e,  i,  Q,  OJ  , M) 


where  all  arguments  have  been  defined  previously. 


Defining  P = {p  , p , p to  be  the  position  of  the  target  planet  relative 
to  the  spacecraft  and  Rp  to  be  the  radius  of  the  target  planet,  the  apparent 
planet  diameter  can  then  be  written  as 
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Partial s of 


fi  with  respect  to  spacecraft  state  are  given  by 


dp 

dx 


2 R 

P 


P 


X 


dP 

dx 


o 


dP  _ 2 RP  pv  dp  = 

' P2  [P1-  */]  4 84 


6£  _ 2 RP  pz  di 

dz  P2  [P2  - \2  } h 82 


The  partial  of  with  respect  to  target  planet  semi-major  axis  is  given 
by 


d£ 

dP 

ax  p 

. aY>  ♦ 

dp  dzp 

d a 

dx 

p 

da 

d y 

p 

da 

a Zp  da 

where  d f3 

d/3 

dp 

= . dP 

dp  = 

dP 

dx 

p 

d x 

dx 

p 

d y 

a z 

p 

dz 

and  partials 

of  X 

, Y 
P P 

and  Z 

P 

with  respect  to  semi-major  axis  are 

summarized  in  the  subroutine  TARPRL  analysis. 

0 • ® 

Partials  of  j3  with  respect  to  Yp,  and  Z „ do  not  appear  in  the  above 

expression  since  they  are  all  zero.  Partials  of  (3  with  respect  to  the 
remaining  target  planet  orbital  elements  are  treated  similarly. 
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TRAKS  Flow  Chart 


TRAKS-8 


Compute  spacecraft  position  and  velocity 
coordinates  relative  to  the  Earth. 


Compute  range  P and  range-rate  P of 
spacecraft  relative  to  the  Earth. 


I0BS  = 0 ? 
NO 

Jl 

ITRK  = 1 ? 


Set 

Y = p and 

NR  = 

1 . 

Set 

Y =[ 

9 ,i>Y 

and 

NR  = 

2 . 

RETURN 


Compute  partials  of  P with  respect 
to  X for  the  idealized  station  and 
insert  in  H matrix.  Set  NR  = ITRK. 


Compute  partials  of  P with  respect 
to  X for  the  idealized  station  and 
insert  in  H matrix. 


RETURN 


TRAKS- 9 


Compute  nominal  altitude,  latitude,  and 
longitude  of  the  IA-th  tracking  station. 


I0BS  4 2 ? 


Compute  actual  altitude,  latitude,  and 
longitude  of  the  IA-th  tracking  station. 


Compute  geocentric  equatorial  components 
of  tracking  station  position  and  velocity 
relative  to  the  center  of  the  Earth. 


Compute  geocentric  ecliptic  components 
of  tracking  station  position  and  velocity 
relative  to  the  Earth. 


Compute  spacecraft  position,  velocity, 
range  p , and  range-rate  f>  relative 
to  IA-th  tracking  station. 


Set  Y = p and  NR  = 1 . 


Set  Y = 
NR  = 2 . 


RETURN 
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• 

Compute  partials  of  P with  respect 
to  X for  the  IA-th  station  and 
insert  in  11  matrix. 

1 

/ Are  any  station 
\ in  <5xg  or 

location  errors  \ 
? / 

YES 



Call  STAPRL  to  compute  partials  of 
station  position  and  velocity  components 

with  respect  to  station  radius  R , 
latitude  9 , and  longitude  0 . 

^ 

K 

i <3p, 

Is  £pk  in 

(Jx  or  5 v ? ^ 

YES 

\ 

t 

Compute  partial  of 
^p^  and  insert  i 

column  of  the  M 

p with  respect  to 
n the  appropriate 

or  L matrix. 

K > 3 ? 


ITRK  > 4 ? 


B 


TRAKS-11 


Is  range- rate  bias  <5/5 


NO 


in 


or 


YES 


Compute  partial  of  P with  respect  to 
8p  and  insert  in  the  appropriate 
column  of  the  M or  L matrix. 


mm 

t 

/ 

ITRK 

\ 

N 

odd? 
/ 

YES 


RETURN 


NO 

\ 

f 

Set  NR  = 2 and  shift  all  previously 
computed  p partials  into  the  2nd 
row  of  the  H,  M,  and  L matrices. 

' 

f 

Compute  partials  of  p with  respect 
to  X for  the  lA-th  station  and 
insert  in  H matrix. 

K = 1 


<5p 


K 


6r  , K=1 
6 G , K=2 
6 9 , k=3 


NO 


\ K 

/ 

YES 

\ 

t 

Compute  partial  of  p with  respect  to 
^Pj,  and  insert  in  the  appropriate 

column  of  the  M or  L matrix. 

YES  > ^ 

^ 

1 Nfl 

< 


K > 3 ? 


K = K + 1 
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ITRK  >4  ? 


Is  range  bias  6p 
in  6xg  or  5v  ? 


Compute  partial  of  p with  respect 
to  bp  and  insert  in  the  appropriate 
column  of  the  M or  L matrix. 


RETURN 


Define  do  loop  parameters 
for  three  simultaneous  star- 
planet  angle  measurements: 
NA=1,  NC=3 , NR=3 


Define  do  loop  parameters 
for  the  appropriate  single 
star-planet  angle  measurement: 
NA=ITRK- 10 , NC=NA,  NR=1 


Compute  target  planet  position  and 
velocity  coordinates  and  range 
relative  to  the  spacecraft. 


TRAKS-13 
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Compute  target  planet  position  and  velocity 
coordinates  and  range  relative  to  space- 
craft. Compute  target  planet  radius. 


Set  Y = 0,  the  apparent 
planet  diameter.  Set  NR=1 


TRAKS-14 


8a  , 

K=1 

8e  , 

K=2 

8 i , 

K=3 

8Q  , 

K=4 

, 

K=5 

aM  , 

K=6 

V 


RETURN 


TRAKS-15 


6 a , K=1 

6 e , K=2 

Si  , K=3 

6 fi  , K=4 

6 <j  , K=5 

6M  > K=6 
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TRANS -1 


TRANS  Analysis 


Subroutine  TRANS  transforms  the  position  and  velocity  components  of  the 
spacecraft  from  one  coordinate  system  to  another.  The  three  options 
available  with  thi3  subroutine  are  summarized  below. 


1)  Convert  from  geocentric  equatorial  coordinates  to  geocentric 
ecliptic  coordinates  using  the  following  equations: 

X = X 

Y = Y Cos  € + Z Sin  € 

Z = -Y  Sin£  + Z Cos  € 

X = X 

y = Y Cos  6+  Z^ Sin  € 

Z = -Y  Sin€  + Z Cos  € 


2)  Convert  from  geocentric  equatorial  coordinates  to  heliocentric 
ecliptic  coordinates.  The  same  procedure  as  above  is  used  to 
convert  from  geocentric  equatorial  to  geocentric  ecliptic.  Then 
translate  according  to  the  following  equations: 


X = X + xE 
Y = Y + Ye 

Z = Z + zE 


• « • 

X = X + x„ 
. . .E 

Y “ Y + Y 

* • • 

z = z + z_ 

E 


3)  Convert  from  geocentric  ecliptic  coordinates  to  heliocentric 
ecliptic  coordinates  using  the  following  equations: 


X = X + xE 

Y " Y + Ye 
Z = Z + Z£ 


• • • 

X = X + x_ 

• • • ii 

Y = Y + Y 

• • o J-j 

Z = z + z_ 

£4 
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TRAPAR  Analysis 


The  coordinate  systems  and  variables  required  for  the  derivation  of  the 
first  four  navigation  parameters  are  shown  in  Figure  1.  The  inertial 
coordinate  system  XYZ  may  be  heliocentric  or  barycentric  ecliptic. 

The  position  and  velocity  of  the  earth  in  inertial  space  is  given  by  r 

E» 

and  v ; that  of  the  spacecraft,  by  r and  v;  and  that  of  the  target 
E 

planet  (or  moon),  by  and  v^p*  The  XYZ  coordinate  system  is 

geocentric  equatorial. 

1.  Flight  path  angle,  * . 

Let  0 denote  the  angle  between  r and  v,  so  that 


cos  9 


and  sin  0 = + 


[l  - cos2  0] 


Then 


y . 


e . 


2.  Angle  between  relative  velocity  and  plane  of  the  sky,  i!0 


The  plane  of  the  sky  is  defined  as  the  plane  perpendicular  to  the 

vector  r - r . Let  0'  denote  the  angle  between  ~r*  - ~r  and 
E E 

v*  - ~vL , so  that 
E 


cos  0 1 “ 


(?- r,).(v -vE)  _ . ..  . r.  , ,i* 


r - r. 


and  sin  01  =■  + 1 - cos^  0' 


Then 


TV 


- 0'  . 


Note  that,  i*  is  not  defined  if  the  relative  velocity  "v  - v^  is  zero. 


3. 


Geocentric  declination,  ft  . 

Let  (x,  y,  z ) denote  the  geocentric  equatorial  componenta  of 
Then 


6 


tan 


-1 


Vx2  + y2  j 


r 
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Figure  1 
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4.  Earth/spacecraft/target  planet  angle,  £ . 

The  angle  £ is  the  angle  between  the  vectors  r - r and  r - "r  , 

E XP 

so  that 


The  next  two  navigation  parameters  relate  to  the  spacecraft  antenna  axis. 
The  pertinent  geometry  is  shown  in  Figure  2.  The  antenna  axis  ct  is 
defined  as  the  intersection  between  the  antenna  plane  (the  plane  perpen- 
dicular to  the  spacecraft  6pin  axis  s ) and  the  plane  formed  by  the 
r*  - "Tg  and  Is  vectors.  The  vector  ~p  originates  from  the  limb  of  the 
sun  and  lies  in  the  ~r,  ct  plane. 


5.  Antenna  axis/Earth  angle,  3 . 

Let  4 ■ denote  the  angle  between  the  unit  spin  axis  vector  if  and 

“r  - *rl,  so  that 
E 


COS  \Jj 


~8  . (r*  - ‘Tg) 


and  sin  \Js  = + 1 


Then 


Note  that  the  antenna  axis  is  not  uniquely  defined  when  the  angle  0 ■ 0. 
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The  angle  0^  denotes  the  angle  between  the  vectors  r and  a , 
so  that 


cos  ©2  “ 


- -r-*  and  sin  0 n + I 1 - cos' 

r 2 L 2 


^ 1 - cos^  0 J 


The  angle  0^  denotes  the  angle  between  the  vectors  p and  r, 
ao  that 


0^  “ sin' 


R 

s 

V r / 


7T 


0 — 0 — 

1 2 


where  R is  the  radius  of  the  Sun, 
s 

Then 


0 = 


The  final  set  of  navigation  parameters  relate  to  spacecraft  occultation 
ratios  for  the  Sun  and  all  other  celestial  bodies  assumed  in  the  dynamic 
model.  The  pertinent  geometry  is  shown  in  Figure  3,  The  position  of 
the  i-th  celestial  body  relative  to  the  Sun  is  denoted  by  Tr^ . Occultation 

parameters  d and  d are  defined  as  the  minimal  distances  from  the 
s i 

centers  of  the  Sun  and  i-th  body,  respectively,  to  the  Earth/spacecraft 

vector  "r  - rL. 

E 

7.  Spacecraft  occultation  ratio  for  the  Sun. 


The  occultation  ratio  for  the  Sun  is  defined  as 


d /R  . 
s s 


where  R is 


the  Sun  radius.  As  long  as  the  occultation  ratio  is  greater  than  one, 

the  spacecraft  is  neither  being  occulted  by  the  Sun  nor  passing  in 

front  of  the  Sun.  The  occultation  ratio  is  computed  only  when  the 

angle  between  the  ~r  - ~r  and  "?  vectors  is  less  than  or  equal  to 

E E 

90  degrees,  or,  equivalently,  when 


r*  . (r*  - *r  ) *=.  o . 
E E 


If  this  condition  is  satisfied,  the  occultation  ratio  is  computed  using 
the  equations 
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Figure  3.  Occultation  Geometry 


and 


b ■ 


-rE*(r"  TE) 


r - r 


Occultation  occurs  if  ~ 1 and  I "r  - "?  I ^ r ; if  “ 4;  1 and 


IF*-  r*  I r , then  the  spacecraft  is  passing  in  front  of  the  Sun. 
1 £ I £ 


Spacecraft  occultation  ratios  for  other  celestial  bodies. 

The  occultation  ratio  for  the  i-th  celestial  body  is  defined  as  d^/R^, 
where  is  the  radius  of  the  i-th  body.  The  occultation  ratio  is 


/ 


TRAPAR-7 


computed  only  when 


<r*  - "r^)  • (rL  - r£)  A 0 


If  this  conditions  is  satisfied,  the  occultation  ratio  is  computed 
using  the  equations 


r 2 2 -l  * 

d,  * a - b 

i L i i J 


ri  " rE 


and 


lr-'E|-(ri  -Te) 


r - r_ 


If  li  t t and  |r-  ~?E  | i -“J  ; 


if 


Occultation  occurs 

— 1 and  I r “ r£  | "^  | ri  ~ rg  | * then  t'ie  spacecraft  is  passing 
is  front  of  the  i-th  celestial  body. 
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TRAPAR  Flow  Chart 
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TRJTRY  Analysis 


TRJTRY  determines  the  time  of  the  next  guidance  event  and  integrates 
the  nominal  trajectory  from  the  previous  ©vent  time  to  the  next  time. 

Special  provisions  must  be  made  in  determining  the  next  guidance  event 
because  of  the  flexibility  permitted  in  specifying  the  times  of  those 
guidance  events.  For  every  guidance  event  i,  parameters  KTIM(i)  and  TIMG(i) 
will  have  been  set  before  entering  TRJTRY.  KTIM(i)  prescribes  the  epoch 
to  which  the  guidance  event  i is  referenced  with  KTIM(i)  *>  1,2,3 
corresponding  to  epochs  of  initial  time,  sphere  of  influence  (SOI)  inter- 
section, and  closest  approach  (CA)  passage  respectively.  TIMG(i)  then 
specifies  the  time  interval  (days)  from  the  epoch  to  the  guidance  event. 

The  guidance  events  do  not  need  to  be  arranged  chronologically.  After 
execution  of  each  guidance  event  i the  flag  KTIM(i)  is  set  equal  to  0. 

The  first  computational  procedure  in  TRJTRY  is  the  sequencing  loop.  Here 
a search  determines  the  minimum  value  of  TIMG(i)  over  all  values  of  i 
such  that  KTIM(i)  = 1.  The  time  interval  At  between  that  time  and  the 
current  time  is  then  computed.  If  At  is  less  than  an  allowable  tolerance 
t (=10  days)  the  program  returns  to  NQMNAL  for  the  processing  of  the 
current  event. 

If  At  TRJTRY  must  perform  an  integration  to  the  next  guidance  event. 
TRJTRY  first  sets  up  flags  controlling  integration  stopping  conditions 
depending  upon  the  current  value  of  KSICA.  The  flag  KSICA  determines 
the  current  phase  of  the  trajectory.  KSICA  is  initially  set  equal  to  1 
(PRELIM).  When  the  target  planet  SOI  is  encountered  KSICA  is  set  to  2. 
Finally  when  CA  to  the  target  planet  occurs  it  is  set  to  3. 

The  stopping  condition  flags  are  ISP2  and  ICL2 . The  flag  ISP2  determines 
whether  the  integration  should  be  stopped  at  SOI  if  encountered  (ISP2  = 1) 
or  not  (ISP2  = 0).  The  flag  ICL2  determines  whether  the  integration  should 
be  stopped  at  CA  if  encountered  (ICL2  = 1)  or  not  (ICL2  = 0). 

Therefore  if  KSICA  ° 1,  TRJTRY  sets  ISP2  = 1 so  that  the  integration  will 
stop  at  the  guidance  event  time  only  if  that  time  occurs  before  SOI.  But 
if  the  SOI  is  encountered  before  the  event  time,  all  times  referenced  to 
the  SOI  must  be  updated  before  determining  the  next  event.  Similarly  when 
KSICA  “ 2 TRJTRY  sets  ICL2  = 1 so  that  times  referenced  to  CA  may  be  up- 
dated when  CA  occurs.  Of  course  when  KSICA  a 3,  all  times  have  been  updated 
(referenced  to  initial  time)  and  neither  ISP2  nor  ICL2  need  be  set  to  1. 

Having  set  the  stopping  condition  flags,  TRJTRY  now  calls  VMP  for  the 
propagation  of  the  trajectory  to  the  required  stopping  condition.  At  the 
end  of  the  integration  it  records  the  current  trajectory  time  and  state. 

TRJTRY  now  sorts  again  on  KSICA.  If  KSICA  Q 3,  the  trajectory  has  been 
integrated  to  the  time  of  the  current  event  and  so  control  may  be  returned 
to  NGMNAL. 
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If  KSICA  ■ 1 the  SOI  had  not  yet  been  reached  at  the  previous  event. 

TRJTRY  then  checks  the  flag  ISPH.  The  flag  ISPH  reveals  whether  the 
current  trajectory  intersected  the  target  planet  SOI  (ISPH  » 1)  or  did 
not  (ISPH  ■ 0).  Therefore  if  ISPH  “ 0,  the  current  guidance  event 
occurred  before  the  trajectory  intersected  the  SOI  and  thus  the  current 
state  corresponds  to  the  time  of  the  guidance  event.  Therefore  the  return 
is  made  to  NQMNAL. 

If  however  KSICA  ■ 1 and  ISPH  « 1 the  trajectory  integration  was  stopped 
at  the  SOI.  TRJTRY  now  sets  KSICA  ■ 2 and  updates  all  timeB  referenced  to 
the  SOI  so  that  they  are  now  referenced  to  initial  time  (KTIM(i)  ■ 1). 

It  reenters  the  sequencing  loop  to  determine  the  time  of  the  next  guidance 
event  where  the  candidate  events  now  include  those  originally  referenced 
to  SOI. 

Similar  steps  are  made  when  KSICA  •=  2.  The  flag  ICL  designates  whether 
the  current  trajectory  had  a CA  (ICL  ■ 1)  or  not  (ICL  = 0).  If  KSICA  ■»  2 
and  ICL  = 0,  the  trajectory  encountered  the  guidance  event  before  reaching 
a CA  so  the  return  is  made  to  NQMNAL.  If  KSICA  ■ 2 and  ICL  « 1,  the  final 
time  and  state  of  the  trajectory  refer  to  closest  approach.  In  this  case 
TRJTRY  sets  KSICA  = 3 and  updates  to  initial  time  all  times  originally 
referenced  to  CA.  It  then  returns  to  the  sequencing  loop. 
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TRJTRY- 3 


ENTER 


At  l f ' 

X 

KSICAe? 


RETURN 


Integrate  trajectory  to  stopping  cond 

(At,SOI,CA)  and  set  t,  ® t + t 

k k a 


RETURN 


IS FH=? 


KSICA= i 

X 

IC1>? 

V 

RETURN 


RETURN 


Set  KSICA  - 3 
For  KTIM(j)=3  set 
TIMG(j)-tk+TIMG(j) 

KTIH(j)  - 1 


VARADA- 1 


VARADA  Analysis 


Subroutine  VARADA  employs  numerical  differencing  to  compute  the  variation 
matrix  T]  for  the  three-variable  B-plane  guidance  policy  in  the  guidance 
event  of  the  error  analysis  mode.  See  subroutine  VARSIM  Analysis  for 
further  analytical  details,  since  the  only  difference  between  VARADA  and 
VARSIM  is  that  VARADA  computations  are  based  on  the  most  recent  targeted 
nominal,  while  VARSIM  computations  are  based  on  the  most  recent  nominal. 
The  VARADA  flow  chart  is  identical  to  that  of  VARSIM  except  for  the  fact 
that  in  VARADA  the  nominal  position/velocity  state  at  t<,j  is  saved 

prior  to  calling  VARADA,  while  in  VARSIM  it  is  saved  locally. 
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VARSIM  Analysis 


Subroutine  VARSIM  employs  numerical  differencing  to  compute  the  variation 

matrix  V for  the  three-variable  15-plane  guidance  policy  in  the  guidance 

event  of  the  simulation  mode.  This  variation  matrix  relates  deviations 

in  the  position/velocity  state  at  t to  deviations  in  B-T,  B-K,  and 

t : k 

SI 


~d  B-T  " 

~ Sr,  ~ 

<5  B-R 
_dtsi. 

» V 

1 

•o 

1 

<>  _ — 

Since  no  good  analytical  formulas  which  relate  0 t to  <5  R and 

S I k 

exist, numerical  differencing  must  be  employed  to  compute  V . 


6v 


Let 


be  the  j-th  column  of  the  matrix  f]  , and  assume  (most  recent) 


nominal  B°T 


^ ^ ^ ^ 
B-R  , tgj,  and  X^  are  available.  To  obtain  f] , 


we 


increment  the  j-th  element  of  by  the  numerical  differencing  factor 

Ax^  and  numerically  integrate  the  spacecraft  equations  of  motion  from  t^ 
to  the  sphere  of  influence  of  the  target  planet  to  obtain  the  new  values 


of  B-T,  B-R,  and  t 


SI 


Then 


"j 


* n 


B-T  - B-T 


Ax, 


B-R  - B-R 

Ax.  “ 


t - t 
SI  SI 


Ax, 


j = 1,2,  , 6 
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VARSIM  Flow  Chart 


ENTER 


Save  B*T , B* R , B,  R and  V for 

bl  SI 

the  most  recent  nominal  trajectory, 


Save  IPRINT  and  set  1PRINT  = 1. 

Save  ISP2  and  then  set  ISP2  = NTP 
so  that  trajectory  integration  will 
stop  at  the  sphere  of  influence. 


Set  column  index  N=1  . 


Set  initial  state  equal  to  most 
recent  nominal  state  at  t^.  Set 

IS PH  = 0. 


N < 4 ? 


Increment  N-th  element  of  state 
by  the  position  numerical  differ- 
encing factor  FACP. 


Increment  N-th  element  of  state 
by  the  velocity  numerical  diff- 
erencing factor  FACV . 


Call  NTMS  to  compute  new 
values  of  B*T,  B»R,  and 
t . 


Did  trajectory  reach 
sphere  of  influence? 


VARSIM-3 
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VECT0R  Analysis 


The  Kepler  vector  k representing  twice  the  areal  rate  of  the  spacecraft 
with  respect  to  the  virtual  mass  to  be  used  during  the  current  interval 
is  computed  from 


k 


x 


<D 


where  the  position  and  velocity  vectors  are  referenced  to  the  virtual  mass 
at  the  beginning  of  the  interval.  The  eccentricity  vector  for  the  interval 
is  given  by 


r 

VS 


B 


(2) 


where  is  the  average  value  of  the  virtual  mass  during  the  interval. 

The  current  time  interval  is  computed  from 

£>T  = At  + K (3) 


where  the  factor  K was  precomputed  during  the  previous  iterations.  The 
direction  of  the  final  position  a is  determined  from 


a - 


(4) 


The  magnitude  factor  B is  chosen  to  force  the  final  position  to  satisfy 
the  orbit  equation  ( e*.  r*  = -r  + Vr  / n ) 


B 


e • a + | <t  j 


(5) 


The  position  and  velocity  vectors  of  the  spacecraft  relative  to  the  virtual 
mass  at  the  end  of  the  interval  are  then 


B a* 


( + 


H .1 


rvs  j 

E J 


(6) 
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The  final  position  and  velocity  of  the  spacecraft  in  the  reference  inertial 
coordinates  are  computed  from 


(7) 


The  exact  conic  section  time  of  flight  is  now  computed.  The  in-plane  normal 
to  the  major  axis  is 


n = 

k e 


k x r 


VS. 


k r, 


VS 


B 


e f 0 


(8) 


e = 0 


The  length  of  the  semi-major  axis  is  given  by 

. 2 


Mv  | 1-e2  I * 


rvs . ’ k ^ M V 

l 


e f 1 


e = 1,  i = B,E 


(9) 


The  projection  of  the  radius  vector  orthogonal  to  the  major  axis  divided 
by  a is  given  by 


n ♦ r. 


VS 


X. 


i = B,  E 


(10) 


The  mean  angular  rate  is 


w = 


M (1-e^) 
V 


ka 


k 

2 


e f 1 


e = 1 


(11) 
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where  w<,0  for  hyperbolic  orbits.  The  eccentric  anomaly  is  given  by 

» sin  * X^  e < 1 

i=B,  E 


Then 


M ■ E, 
i i 


k2/ u X 
M V 1 


= sinh" 1 X. 


e X i = B, E 

i 


e “ 1 
e >1 


(12) 


(13) 


and  the  actual  conic  time  of  flight  is 


M _ M 

At  ’ CE  - CB  * (U> 

The  value  of  the  time  factor  K to  be  used  in  the  following  interval  is 
then  computed 


At-  At 

2 

(At) 


(15) 
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VECTOR  Flow  Chart 
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VMASS  Analysis 


The  current  virtual  mass  data  is  computed  by  VMASS, 
position  of  the  virtual  mass  is  given  by 


The  magnitude  and 


- r M 
VS  s 

_M 

M_ 


(1) 

(2) 


intermediate 

variables  are 

n 

H r*. 

ii 

IS 

£ 

i i 
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i=l 

n 

r 

iS 

M 

£ 

*i 

S 

3 

i=l 

r 

iS 

and  of  course  r = I "r  - 7* 
iS  1 i S 


and  r 


VS 


r - r 
V S 


the  inertial  position  vector  of  the  i-th  body. 

The  time  derivatives  of  these  variables  are  given  by 

M 

4 = M (a  + — ) 

M V V V M 


(3) 


(4) 


where  r^  represents 


(5) 


M - r M 
V S 
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(6) 


M = 


n 

£ 

i=i 
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r - r a 
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_ 3 
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iS 
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where 


a 


IS 


3 riS*  riS 


IS 


(9) 


Finally,  the  velocity  of  the  spacecraft  with  respect  to  the  virtual  mass 
is 


VS 


jl. j,  JLa 

r - r 
S V 


(10) 
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VMASS  Flow  Chart 
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VMP  Analysis 


VMP  provides  the  logic  to  integrate  an  N-body  trajectory  from  an 
initial  spacecraft  state  (rg,  vg)  at  time  tfi  to  one  of  the  following 
stopping  conditions. 

1.  Target  planet  sphere  of  Influence  (SOI)  is  reached 
(ISP2  0). 

2.  The  closest  approach  to  the  target  planet  has  been  reached 
(IGL2  =1). 

3.  The  preset  final  trajectory  time  t has  been  exceeded. 

The  integration  logic  is  controlled  by  ITRAT 

ITRAT  = 1 First  pass  through  computation  cycle  (Including 
ephemeris  computation). 

2 Second  pass  through  computation  cycle  (excluding 
ephemeris). 

3 Initialization  flag. 

To  start  the  integration,  appropriate  variables  are  initialized 
(PRINTZ)  and  ITRAT  is  set  equal  to  3.  The  state  of  all  gravitational 
bodies  at  tD  are  found  (ORB,  EPHEM) . The  initial  virtual  mass  position 

D 

r , velocity  v..  , magnitude  n and  magnitude  rate  /i  are  found  by 
B VB  VB  VB 

VMASS.  Virtual  mass  dependent  values  are  then  initilized 


^ v 

AVE 

a U a LL 

**v  Mv 

E B 

(1) 

rv 

AVE 

• 

6?  r 

VB 

(2) 

r 

VSE 

= r 

VSB 

(3) 

X 

=>  f 

VSB 

(4) 

(At)2 

= 1 

(5) 

ISPHl 

= 0 

(6) 
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At  this  point  the  standard  Integration  routine  Is  entered  by  calling 
VECTOR. 

In  the  standard  Integration  routine,  a new  Increment  Is  Initiated  by 
calling  ESTMT  which: 

1.  Initializes  all  appropriate  variables  at  the  beginning 
of  the  increment  (subscript  B)  to  equal  their  values 
at  the  end  of  the  previous  increment. 

2.  Computes  a At  for  the  Increment  based  on  a modified 
true  anomaly  passage. 

3.  Computes  the  time  at  the  end  of  the  increment  t . 

hi 

4.  Estimates  the  final  (subscript  E)  position  r^  and  magnitude 

H of  the  virtual  mass.  E 

VE 

Based  on  these  estimates,  the  average  magnitude  and  velocity  of  the 
virtual  mass  is  computed 

^ - 1/2  (ji  ) (7) 

AVE  B E 

vv  " <*v  " *V  )/At  (8) 

AVE  E B 

Subroutine  VECTOR  then  computes  the  orbit  relative  to  the  virtual 
mass  based  on  these  estimates.  It  also  refines  the  estimate  of  the 
spacecraft  final  state  (r  , v ).  ORB  and  EPHEM  are  called  to  deter- 

SE  SE 

mine  the  state  at  t^  of  all  gravitational  bodies  being  considered.  The 
virtual  mass  position  r , velocity  v , magnitude  n and  magnitude 

VE  VE  VE 

rate  £ are  determined  by  VMASS. 

VE 

Using  these  refined  values,  the  virtual  mass  average  magnitude  p 

VAVE 

and  velocity  vv  are  recomputed  using  equations  (7)  and  (8).  At  this 

point  a second  pass  is  made  through  VECTOR  to  compute  the  spacecraft 
final  state  (r  , v ) which  will  be  used  in  all  subsequent  calculations 
E SE 

VMASS  is  again  called  to  make  a final  determination  of  the  virtual  mass 


VMP-3 


position,  velocity,  magnitude  and  magnitude  rate  at  the  end  of  the 
increment . 

The  virtual  mass  average  accelerations  are  then  computed 


These  values  are  subsequently  used  by  ESTMT  to  estimate  the  final 
position  r^,  and  magnitude  of  the  virtual  mass  for  the  next 

increment , 

Tests  are  now  made  to  determine  whether  the  vehicle  is  inside  a 
planetocentric  sphere  of  radius  1.025  times  larger  than  that  of 
the  S0I.  If  it  is  not,  integration  goes  on  as  usual.  If  it  is 
and  yet  is  still  outside  the  S0I,  the  integration  step  size  is 
reduced  to  obtain  an  integration  state  near  enough  the  S0I  to 
permit  accurate  extrapolation  to  it.  Finally,  if  the  vehicle 
is  inside  of  the  sphere  of  influence,  a refined  sphere  of  in- 
fluence (S0I)  state  is  constructed  by  fitting  an  osculating 
planetocentric  conic  to  the  current  state  and  extrapolating  it 
to  the  sphere.  The  entire  refinement  process  is  carried  out  in 
subroutine  S0IPS. 

The  refined  state  at  the  S0I  is  then  used  by  IMPACT  to  compute 
B°T  and  B*R. 

If  trajectory  data  are  to  be  printed  at  this  point,  the  orbit 
inclination  (assuming  a hyperbolic  orbit  about  the  planet)  is 
computed  by  first  determining  the  ''Kepler  vector" 

k = rgT  x vgT  (11) 

in  planetocentric  equatorial  coordinates.  Then 

k 

cos  i = — (12) 

1*1 

-v 

where  i = orbit  inclination  and  k = component  of  k normal  to  planet 
equatorial  plane. 
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Tests  are  now  made  to  determine  if  the  spacecraft  has  reached  a 
closest  approach  to  the  target  planet.  If  it  has,  the  interpo- 
lated state  at  closest  approach  |r^,  comPute^  by  calling 

CAREL  with  the  spacecraft  state  just  following  closest  approach. 
CAREL  returns  the  element  of  the  near  planet  conic.  ELCAR  is 
then  called  with  these  conic  elements  and  returns  the  interpo- 
lated state  at  closest  approach. 

If  the  spacecraft  is  not  within  10  SOI  of  the  target  planet, 
printout  of  closest  approach  data  may  occur;  however,  integra- 
tion continues . 

The  final  tests  before  starting  a new  integration  increment  de- 
termine if  the  maximum  trajectory  time  t^  has  been  exceeded  or 

a planet  has  been  impacted.  If  the  latter  has  occurred,  the 
actual  impact  state  is  determined  by  fitting  an  osculating 
planetocentric  conic  to  the  current  state  and  extrapolating  to 
the  planet  surface.  As  was  the  case  earlier  at  the  SOI,  this 
procedure  is  carried  out  in  the  subroutine  S0IPS.  If  the  im- 
pacted planet  is  the  object  of  any  type  of  probe  targeting,  the 
planet  radius  used  in  the  impact  state  computation  is  the  probe- 
sphere  value  input  by  the  user.  If  these  final  two  tests  are 
passed,  a new  integration  cycle  is  initiated  by  calling  ESTMT. 
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ZERIT- 1 


ZERIT  Analysis 

ZERIT  is  the  executive  subroutine  handling  the  computation  of  the  zero 
iterate  values  of  time,  position  vector,  and  velocity  vector. 

The  flag  IZERO  controls  the  operation  of  ZERIT.  If  IZERO  = 0,  no  zero 
iterate  computation  is  needed  and  so  ZERIT  is  exited.  If  IZERO  <T 10,  the 
zero  iterate  is  to  be  computed  for  a interplanetary  trajectory  so  HELIO 
is  called  before  returning.  If  IZERO 10,  the  zero  iterate  is  to  be 
computed  for  a lunar  trajectory  so  LUNA  is  called  for  that  computation. 


ZERIT  Flow  Chart 
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